modbus.c
#include "modbus.h"
#include "crc16.h"
#include "uart2.h"
#define HoldRegStartAddr 0x0000 //保持寄存器起始地址
#define HoldRegCount 8 //保持寄存器数量
#define HoldMaxValue 1000 //寄存器最大值
extern u8 data_backup[DMA_REC_LEN]; //modbus接收到数据备份
extern u16 dataLen_backup; //modbus接收数据长度备份
u8 SendBuf[DMA_REC_LEN] = {0};
u16 StartRegAddr = HoldRegStartAddr;
u8 err = 0; //错误代码
u8 HoldReg[HoldRegCount*2] = {1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 8}; //存储8路数据值
/*
错误代码说明:
0x01 不是支持的功能码
0x02 起始地址不在规定范围内
0x03 寄存器数量不在规定范围内
0x04 数据校验错误
*/
//处理接收到的数据
// 接收: [地址][功能码][起始地址高][起始地址低][总寄存器数高][总寄存器数低][CRC低][CRC高]
void DisposeReceive( void )
{
u16 CRC16 = 0, CRC16Temp = 0;
if( data_backup[0] == SlaveID ) //地址等于本机地址 地址范围:1 - 32
{
CRC16 = App_Tab_Get_CRC16( data_backup, dataLen_backup - 2 ); //CRC校验 低字节在前 高字节在后 高字节为报文最后一个字节
CRC16Temp = ( ( u16 )( data_backup[dataLen_backup - 1] << 8 ) | data_backup[dataLen_backup - 2] );
if( CRC16 != CRC16Temp )
{
err = 4; //CRC校验错误
}
StartRegAddr = ( u16 )( data_backup[2] << 8 ) | data_backup[3];
if( StartRegAddr > (HoldRegStartAddr + HoldRegCount - 1) )
{
err = 2; //起始地址不在规定范围内 00 - 07 1 - 8号通道
}
if( err == 0 )
{
switch( data_backup[1] ) //功能码
{
case 3: //读多个寄存器
{
Modbus_03_Slave();
break;
}
case 6: //写单个寄存器
{
Modbus_06_Slave();
break;
}
case 16: //写多个寄存器
{
Modbus_16_Slave();
break;
}
default:
{
err = 1; //不支持该功能码
break;
}
}
}
if( err > 0 )
{
SendBuf[0] = data_backup[0];
SendBuf[1] = data_backup[1] | 0x80;
SendBuf[2] = err; //发送错误代码
CRC16Temp = App_Tab_Get_CRC16( SendBuf, 3 ); //计算CRC校验值
SendBuf[3] = CRC16Temp & 0xFF; //CRC低位
SendBuf[4] = ( CRC16Temp >> 8 ); //CRC高位
uart2_Send( SendBuf, 5 );
err = 0; //发送完数据后清除错误标志
}
}
}
/*
函数功能：读保持寄存器 03
主站请求报文: 0x01 0x03 0x0000 0x0001 0x840A 读从0开始的1个保持寄存器
从站正常响应报文: 0x01 0x03 0x02 0x09C4 0xBF87 读到的2字节数据为 0x09C4
*/
void Modbus_03_Slave( void )
{
u16 RegNum = 0;
u16 CRC16Temp = 0;
u8 i = 0;
RegNum = ( u16 )( data_backup[4] << 8 ) | data_backup[5]; //获取寄存器数量
if( ( StartRegAddr + RegNum ) <= (HoldRegStartAddr + HoldRegCount) ) //寄存器地址+寄存器数量 在规定范围内 <=8
{
SendBuf[0] = data_backup[0]; //地址
SendBuf[1] = data_backup[1]; //功能码
SendBuf[2] = RegNum * 2; //返回字节数量
for( i = 0; i < RegNum; i++ ) //循环读取保持寄存器内的值
{
SendBuf[3 + i * 2] = HoldReg[StartRegAddr * 2 + i * 2];
SendBuf[4 + i * 2] = HoldReg[StartRegAddr * 2 + i * 2 + 1];
}
CRC16Temp = App_Tab_Get_CRC16( SendBuf, RegNum * 2 + 3 ); //获取CRC校验值
SendBuf[RegNum * 2 + 3] = CRC16Temp & 0xFF; //CRC低位
SendBuf[RegNum * 2 + 4] = ( CRC16Temp >> 8 ); //CRC高位
uart2_Send( SendBuf, RegNum * 2 + 5 );
}
else
{
err = 3; //寄存器数量不在规定范围内
}
}
/*
函数功能:写单个保持寄存器 06
主站请求报文: 0x01 0x06 0x0000 0x1388 0x849C 写0号寄存器的值为0x1388
从站正常响应报文: 0x01 0x06 0x0000 0x1388 0x849C 0号寄存器的值为0x1388
*/
void Modbus_06_Slave( void )
{
u16 RegValue = 0;
u16 CRC16Temp = 0;
RegValue = ( u16 )( data_backup[4] << 8 ) | data_backup[5]; //获取寄存器值
if( RegValue <= HoldMaxValue ) //寄存器值不超过1000
{
HoldReg[StartRegAddr * 2] = data_backup[4]; //存储寄存器值
HoldReg[StartRegAddr * 2 + 1] = data_backup[5];
SendBuf[0] = data_backup[0]; //地址
SendBuf[1] = data_backup[1]; //功能码
SendBuf[2] = data_backup[2]; //地址高位
SendBuf[3] = data_backup[3]; //地址低位
SendBuf[4] = data_backup[4]; //值高位
SendBuf[5] = data_backup[5]; //值低位
CRC16Temp = App_Tab_Get_CRC16( SendBuf, 6 ); //获取CRC校验值
SendBuf[6] = CRC16Temp & 0xFF; //CRC低位
SendBuf[7] = ( CRC16Temp >> 8 ); //CRC高位
uart2_Send( SendBuf, 8 );
}
else
{
err = 3; //寄存器数值不在规定范围内
}
}
/*
函数功能:写多个连续保持寄存器值 16
主站请求报文: 0x01 0x10 0x7540 0x0002 0x04 0x0000 0x2710 0xB731 写从0x7540地址开始的2个保持寄存器值 共4字节
从站正常响应报文: 0x01 0x10 0x7540 0x0002 0x5A10 写从0x7540地址开始的2个保持寄存器值
*/
void Modbus_16_Slave( void )
{
u16 RegNum = 0;
u16 CRC16Temp = 0;
u8 i = 0;
RegNum = ( u16 )( data_backup[4] << 8 ) | data_backup[5]; //获取寄存器数量
if( ( StartRegAddr + RegNum ) <= (HoldRegStartAddr + HoldRegCount) ) //寄存器地址+寄存器数量 在规定范围内 <=8
{
for( i = 0; i < RegNum; i++ ) //存储寄存器设置值
{
HoldReg[StartRegAddr * 2 + i * 2] = data_backup[i * 2 + 7];
HoldReg[StartRegAddr * 2 + 1 + i * 2] = data_backup[i * 2 + 8];
}
SendBuf[0] = data_backup[0]; //起始地址
SendBuf[1] = data_backup[1]; //功能码
SendBuf[2] = data_backup[2]; //地址高位
SendBuf[3] = data_backup[3]; //地址低位
SendBuf[4] = data_backup[4]; //寄存器数量高位
SendBuf[5] = data_backup[5]; //寄存器数量低位
CRC16Temp = App_Tab_Get_CRC16( SendBuf, 6 ); //获取CRC校验值
SendBuf[6] = CRC16Temp & 0xFF; //CRC低位
SendBuf[7] = ( CRC16Temp >> 8 ); //CRC高位
uart2_Send( SendBuf, 8 );
}
else
{
err = 3; //寄存器数量不在规定范围内
}
}
| 
楼主
