- /**********************************************************************************************************
- * 文 件: modbus_rtu_slave.c
- * 版 本: v1.0.0
- * 编 写:
- * 说 明: modbus从站协议
- * 版 本:
- * Copyright (C), 2021-2031 xxxx
- *********************************************************************************************************/
- #include "at32f4xx.h"
- #include "modbus_rtu.h"
- #include "bsp_usart.h"
- #include "queue.h"
- uint16_t RTU_M_buf[RTU_M_BUF_SIZE]; // 位寄存器区
- uint16_t RTU_D_buf[RTU_D_BUF_SIZE]; // 字寄存器区
- extern void modbus_rtu_01H( void );
- extern void modbus_rtu_05H( void );
- extern void modbus_rtu_03H( void );
- extern void modbus_rtu_06H( void );
- extern void modbus_rtu_10H( void );
- extern void rs485_dma_tx( uint8_t len );
- extern void error_back( uint8_t func, uint8_t type );
- /*******************************************************************************
- * 16位CRC检验表,低位在前,高位在后
- *
- *
- ******************************************************************************/
- /* 高位表 */
- uint8_t const auchCRCHi[256] =
- {
- 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
- };
- /* 低位表 */
- uint8_t const auchCRCLo[256] =
- {
- 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
- };
- /**************************************************************************************************
- * brief 16位CRC校验函数,查表法
- * param
- * note
- *************************************************************************************************/
- uint16_t CRC16_calc( uint8_t *puchMsg, uint8_t usDataLen )
- {
- uint8_t uchCRCHi = 0xFF ;
- uint8_t uchCRCLo = 0xFF ;
- uint16_t uIndex ;
- while( usDataLen-- )
- {
- uIndex = uchCRCHi ^ *puchMsg++ ;
- uchCRCHi = uchCRCLo ^ auchCRCHi[uIndex] ;
- uchCRCLo = auchCRCLo[uIndex] ;
- }
- return ( ( uint16_t )( uchCRCLo ) << 8 | uchCRCHi ) ;
- }
- /*
- 关于 Modbus 各地址的说明
- --------------------------------------------------------------------------------
- EasyBuilder Pro 中 Modbus 协议的地址类型为 0x、1x、3x、4x、5x、6x,还有 3x_Bit、4x_Bit 、6x_Bit 等等,下面将分别说明这些地址类型在 Modbus 协议中支持的功能码。
- 地址类型 描述
- 0x 是个可读可写的地址类型,相当于操作设备的输出点。该地址类型读位状态时的功能码为 01H,写位状态时的功能码为 05H。写多个位寄存器时的功能码为 0fH。
- 1x 是个只读的地址类型,相当于读设备的输入点。读位状态时的功能码为 02H。
- 3x 是个只读的地址类型,相当于读设备的只读数据寄存器。读数据时的功能码为 04H。
- 4x 是个可读可写的地址类型,相当于操作设备的数据寄存器。当读数据时的功能码为 03H,当写数据时的功能码为 10H。
- 5x 该地址类型与 4x 属性是一样的。即读写的功能码完全一样。不同之处在于,当为双字时,若 32_bit unsigned 格式的数据,使用 5x 和 4x 两种地址类型分别读取数据时,
- 高字和低字的位置是颠倒的。若使用 4x 地址类型读到的数据是 0x1234,则使用 5x 地址类型读取的数据即为 0x3412。
- 6x 是一个可读可写的地址类型,读数据时的功能码也是 03H,与 4x 不同之处在于写数据时的功能码为 06H,即写单个寄存器的数据。
- 3x_Bit 该地址类型支持的功能码与 3x 地址类型完全一致,不同之处在于 3x 是读数据,而 3x_Bit 是读数据中的某一个 bit 的状态。
- 4x_Bit 该地址类型支持的功能码与 4x 地址类型完全一致,不同之处在于 4x 是读数据,而 4x_Bit 是读数据中的某一个 bit 的状态。
- 6x_Bit 该地址类型支持的功能码与 6x 地址类型完全一致,不同之处在于 6x 是读数据,而 6x_Bit 是读数据中的某一个 bit 的状态。
- */
- /**************************************************************************************************
- * brief MODBUS功能码处理
- * param
- * note 目前只能识别01,03,05,06功能码,而且只能挂载单台
- * note 在uart 接收字符间隔超3.5字符的定时器中断中调用
- **************************************************************************************************/
- void modbus_rtu_analyze( void )
- {
- uint16_t crc_val = 0;
- #if 0
- uint8_t i = 0;
- uint8_t rece_byte = 8;
- while( Queue_Out( &sQueUart, &UartR_buf[i++] ) )
- {
- rece_byte++;
- }
- #endif
- if( Uart_dma_rxbyte < 8 ) return; /* 有效报文的字节数量最少是8个字节 */
- if( UartR_buf[0] == 0x01 ) /* 站号,本站0x01 */
- {
- /* 接收到的CRC校验码,低字节在前,高字节在后 */
- crc_val = ( UartR_buf[Uart_dma_rxbyte - 1] << 8 ) | UartR_buf[Uart_dma_rxbyte - 2];
- /* CRC 校验正确 */
- if( crc_val == CRC16_calc( UartR_buf, Uart_dma_rxbyte - 2 ) )
- {
- modbus_rtu_01H();
- modbus_rtu_05H();
- modbus_rtu_03H();
- modbus_rtu_06H();
- modbus_rtu_10H();
- }
- else /* 返回校验错误代码 */
- {
- error_back( UartR_buf[1], 0x08 );
- }
- }
- }
- /**************************************************************************************************
- * brief : 01功能码,
- * param :
- * note : 位读取,HMI的地址类型0x
- **************************************************************************************************/
- void modbus_rtu_01H( void )
- {
- /* 协议
- 主机发送:
- rbuf[0] 01 从机地址
- rbuf[1] 01 功能码
- rbuf[2] xx 寄存器起始地址高字节
- rbuf[3] xx 寄存器起始地址低字节
- rbuf[4] xx 寄存器数量高字节
- rbuf[5] xx 寄存器数量低字节
- rbuf[6] xx CRC校验低字节
- rbuf[7] xx CRC校验高字节
- 从机应答:
- tbuf[1] 01 从机地址
- tbuf[2] 01 功能码
- tbuf[3] xx 返回字节数
- tbuf[4] xx 数据1
- tbuf[5] xx 数据2
- tbuf[6] xx 数据3
- tbuf[7] xx 数据4
- tbuf[8] xx 数据5
- tbuf[9] xx CRC校验高字节
- tbuf[10] xx CRC校验低字节
- */
- uint16_t i, j;
- uint16_t bit_base;
- uint16_t bit_addr;
- uint16_t bit_len;
- uint8_t bit_baseH, bit_baseL;
- uint8_t bit_lenH, bit_lenL;
- uint8_t bit_Val;
- uint16_t crc_val;
- if( UartR_buf[1] == 0x01 )
- {
- bit_baseH = UartR_buf[2]; /* 位首址高字节 */
- bit_baseL = UartR_buf[3]; /* 位首址低字节 */
- bit_lenH = UartR_buf[4]; /* 位长高字节 */
- bit_lenL = UartR_buf[5]; /* 位长低字节 */
- bit_base = ( bit_baseH << 8 ) + bit_baseL; /* 位首址,16位 */
- bit_len = ( bit_lenH << 8 ) + bit_lenL; /* 位长,16位 */
- if( ( bit_base + bit_len ) >= RTU_M_BUF_SIZE * 16 ) /* 位地址超出范围 */
- {
- // errorsend( 0x01, 0x02 ); /* */
- return;
- }
- UartT_buf[0] = UartR_buf[0]; /* 站号 */
- UartT_buf[1] = UartR_buf[1]; /* 功能码 */
- UartT_buf[2] = ( bit_len / 8 ) + ( ( bit_len % 8 ) != 0 ); /* 要返回的字节数, 不能整除8的时候要多返回一个字节 */
- for( i = 0; i < UartT_buf[2]; i++ )
- {
- UartT_buf[ 3 + i ] = 0; /* 先清零复位 */
- for( j = 0; j < 8; j++ ) /* 每8个位状态组成一个字节返回 */
- {
- /* RTU_M_buf[] 为16位数组,取8个位状态组成一个字节,算法:位在数组中的单元地址 = 位地址/16, 在16位数据的位 = 位地址 %16 */
- bit_addr = bit_base + i * 8 + j;
- bit_Val = ( uint8_t )( RTU_M_buf[ bit_addr / 16 ] >> ( bit_addr % 16 ) ) & 0x01;
- UartT_buf[ 3 + i ] |= bit_Val << j; /* 位读取顺序,低位在前,高位在后;位排列顺序,MSB..LSB */
- }
- }
- crc_val = CRC16_calc( UartT_buf, UartT_buf[2] + 3 ); /* CRC校验 */
-
- UartT_buf[3 + UartT_buf[2] ] = ( uint8_t )( crc_val ); /* CRC低字节 */
- UartT_buf[4 + UartT_buf[2] ] = ( uint8_t )( crc_val >> 8 ); /* CRC高字节 */
- rs485_dma_tx( UartT_buf[2] + 5 );
- }
- }
- /**************************************************************************************************
- * brief 05功能码
- * param
- * note 写单个位状态,HMI的地址类型0x
- **************************************************************************************************/
- void modbus_rtu_05H( void )
- {
- uint16_t crc_val, bit_addr;
- if( UartR_buf[1] == 0x05 )
- {
- bit_addr = UartR_buf[2] << 8 | UartR_buf[3]; /* 位地址 */
- if( UartR_buf[4] == 0xff ) /* 强制ON */
- {
- RTU_M_buf[bit_addr / 16] |= 0x0001 << ( bit_addr % 16 );
- }
- else /* 强制OFF */
- {
- RTU_M_buf[bit_addr / 16] &= ~( 0x0001 << ( bit_addr % 16 ) );
- }
- UartT_buf[0] = UartR_buf[0]; /* 站号 */
- UartT_buf[1] = UartR_buf[1]; /* 功能码 */
- UartT_buf[2] = UartR_buf[2]; /* 起始地址高字节 */
- UartT_buf[3] = UartR_buf[3]; /* 起始地址低字节 */
- UartT_buf[4] = UartR_buf[4]; /* 返回状态高字节 */
- UartT_buf[5] = UartR_buf[5]; /* 返回状态低字节 */
- crc_val = CRC16_calc( UartT_buf, 6 ); /* 校验 */
- UartT_buf[6] = ( uint8_t )( crc_val ); /* 校验低位 */
- UartT_buf[7] = ( uint8_t )( crc_val >> 8 ); /* 校验高位 */
- rs485_dma_tx( 8 ); /* 发送返回 */
- }
- }
- /**************************************************************************************************
- * brief 03功能码
- * param
- * note 读取多个寄存器,HMI的地址类型6x、4x
- * note 读取16位字寄存器区RTU_D_buf
- **************************************************************************************************/
- void modbus_rtu_03H( void )
- {
- uint16_t i = 0, idx = 0;
- uint16_t reg_base, len_words, len_byte;
- uint16_t crc_val;
- if( UartR_buf[1] == 0x03 )
- {
- reg_base = ( UartR_buf[2] << 8 ) | UartR_buf[3]; /* 寄存器地址 */
- len_words = ( UartR_buf[4] << 8 ) | UartR_buf[5]; /* 读取的字长 */
- len_byte = len_words * 2; /* 字节数 */
- UartT_buf[idx++] = UartR_buf[0]; /* 站号 */
- UartT_buf[idx++] = UartR_buf[1]; /* 功能码 */
- UartT_buf[idx++] = ( uint8_t )( len_words * 2 ); /* 字节数 */
- for( i = 0; i < len_words; i++ ) /* 发送相应字节 */
- {
- UartT_buf[idx++] = ( uint8_t )( RTU_D_buf[reg_base + i] >> 8 ); /* 数据高字节 */
- UartT_buf[idx++] = ( uint8_t )( RTU_D_buf[reg_base + i] ); /* 数据低字节 */
- }
- len_byte = idx;
- crc_val = CRC16_calc( UartT_buf, len_byte ); /* 校验 */
- UartT_buf[idx++] = ( uint8_t )( crc_val ); /* 校验低位 */
- UartT_buf[idx++] = ( uint8_t )( crc_val >> 8 ); /* 校验高位 */
- len_byte = idx;
- rs485_dma_tx( len_byte ); /* 返回 */
- }
- }
- /**************************************************************************************************
- * brief 06功能码
- * param
- * note 写单个寄存器,HMI的地址类型6x
- **************************************************************************************************/
- void modbus_rtu_06H( void )
- {
- uint16_t reg_addr, reg_val, crc_val;
- if( UartR_buf[1] == 0x06 ) /* 功能码 */
- {
- reg_addr = ( UartR_buf[2] << 8 ) | UartR_buf[3]; /* 写入地址 */
- reg_val = ( UartR_buf[4] << 8 ) | UartR_buf[5]; /* 寄存器值 */
- RTU_D_buf[reg_addr] = reg_val; /* 存入字寄存器区 */
- UartT_buf[0] = UartR_buf[0]; /* 站号 */
- UartT_buf[1] = UartR_buf[1]; /* 功能码 */
- UartT_buf[2] = UartR_buf[2]; /* 寄存器地址高字节 */
- UartT_buf[3] = UartR_buf[3]; /* 寄存器地址低字节 */
- UartT_buf[4] = UartR_buf[4]; /* 数据高字节 */
- UartT_buf[5] = UartR_buf[5]; /* 数据低字节 */
- crc_val = CRC16_calc( UartT_buf, 6 ); /* 校验 */
- UartT_buf[6] = ( uint8_t )( crc_val ); /* 校验低位 */
- UartT_buf[7] = ( uint8_t )( crc_val >> 8 ); /* 校验高位 */
- rs485_dma_tx( 8 ); /* 返回 */
- }
- }
- /**************************************************************************************************
- * brief 10H功能码
- * param
- * note 写多个寄存器, HMI的地址类型4x
- **************************************************************************************************/
- void modbus_rtu_10H( void )
- {
- uint16_t reg_base;
- uint16_t reg_num;
- uint16_t crc_val, i;
- uint8_t w_bytes;
- if( UartR_buf[1] == 0x10 )
- {
- reg_base = ( UartR_buf[2] << 8 ) + UartR_buf[3]; /* 要写入的起始地址 */
- reg_num = ( UartR_buf[4] << 8 ) + UartR_buf[5]; /* 寄存器数量 */
- w_bytes = UartR_buf[6]; /* 要写的字节数量 */
- for( i = 0; i < ( w_bytes / 2 ); i++ ) /* 将值写入寄存器 */
- {
- RTU_D_buf[reg_base + i] = ( UartR_buf[7 + i * 2] << 8 ) + UartR_buf[8 + i * 2];
- }
- UartT_buf[0] = UartR_buf[0]; /* 站号 */
- UartT_buf[1] = UartR_buf[1]; /* 功能码 */
- UartT_buf[2] = UartR_buf[2]; /* 返回地址高位 */
- UartT_buf[3] = UartR_buf[3]; /* 返回地址低位 */
- UartT_buf[4] = UartR_buf[4];
- UartT_buf[5] = UartR_buf[5];
- crc_val = CRC16_calc( UartT_buf, 6 ); /* CRC校验 */
- UartT_buf[6] = ( uint8_t )( crc_val ); /* CRC低字节 */
- UartT_buf[7] = ( uint8_t )( crc_val >> 8 ); /* CRC高字节 */
- rs485_dma_tx( 8 );
- }
- }
- #if 1
- /*错误返回*/
- void error_back( uint8_t func, uint8_t type )
- {
- uint16_t crc_val;
- UartT_buf[0] = 0x01; /* 返回站号 */
- switch( type )
- {
- case 0x08:
- UartT_buf[1] = 0x80 + func; /* 返回错误功能码 */
- UartT_buf[2] = 0x08; /* 返回错误代码,08:CRC校验错误 */
- break;
- case 0x01:
- UartT_buf[1] = 0x80 + func; /* 返回错误功能码 */
- UartT_buf[2] = 0x01; /* 返回错误代码,01:功能码错误 */
- break;
- case 0x02:
- UartT_buf[1] = 0x80 + func; /* 返回错误功能码 */
- UartT_buf[2] = 0x02; /* 返回错误代码,02:地址错误 */
- break;
- case 0x03:
- UartT_buf[1] = 0x80 + func; /* 返回错误功能码 */
- UartT_buf[2] = 0x03; /* 返回错误代码,03:数据错误 */
- break;
- case 0x04:
- UartT_buf[1] = 0x80 + func; /* 返回错误功能码 */
- UartT_buf[2] = 0x04; /* 返回错误代码,04:不支持的功能码 */
- break;
- }
- crc_val = CRC16_calc( UartT_buf, 3 ); /* CRC校验 */
- UartT_buf[3] = (uint8_t)(crc_val); /* 校验低字节 */
- UartT_buf[4] = (uint8_t)(crc_val>>8); /* 校验高字节 */
- rs485_dma_tx(5);
- }
- #endif