@@ -0,0 +1,82 @@ | |||
<?xml version="1.0" encoding="utf-8"?> | |||
<Project DefaultTargets="Build" ToolsVersion="12.0" xmlns="http://schemas.microsoft.com/developer/msbuild/2003"> | |||
<ItemGroup Label="ProjectConfigurations"> | |||
<ProjectConfiguration Include="Debug|Win32"> | |||
<Configuration>Debug</Configuration> | |||
<Platform>Win32</Platform> | |||
</ProjectConfiguration> | |||
<ProjectConfiguration Include="Release|Win32"> | |||
<Configuration>Release</Configuration> | |||
<Platform>Win32</Platform> | |||
</ProjectConfiguration> | |||
</ItemGroup> | |||
<PropertyGroup Label="Globals"> | |||
<ProjectGuid>{CB8E0444-CD69-430B-8ACF-8083D140A65F}</ProjectGuid> | |||
<RootNamespace>Master_Salve_DLL</RootNamespace> | |||
</PropertyGroup> | |||
<Import Project="$(VCTargetsPath)\Microsoft.Cpp.Default.props" /> | |||
<PropertyGroup Condition="'$(Configuration)|$(Platform)'=='Debug|Win32'" Label="Configuration"> | |||
<ConfigurationType>DynamicLibrary</ConfigurationType> | |||
<UseDebugLibraries>true</UseDebugLibraries> | |||
<PlatformToolset>v120</PlatformToolset> | |||
<CharacterSet>MultiByte</CharacterSet> | |||
</PropertyGroup> | |||
<PropertyGroup Condition="'$(Configuration)|$(Platform)'=='Release|Win32'" Label="Configuration"> | |||
<ConfigurationType>Application</ConfigurationType> | |||
<UseDebugLibraries>false</UseDebugLibraries> | |||
<PlatformToolset>v120</PlatformToolset> | |||
<WholeProgramOptimization>true</WholeProgramOptimization> | |||
<CharacterSet>MultiByte</CharacterSet> | |||
</PropertyGroup> | |||
<Import Project="$(VCTargetsPath)\Microsoft.Cpp.props" /> | |||
<ImportGroup Label="ExtensionSettings"> | |||
</ImportGroup> | |||
<ImportGroup Label="PropertySheets" Condition="'$(Configuration)|$(Platform)'=='Debug|Win32'"> | |||
<Import Project="$(UserRootDir)\Microsoft.Cpp.$(Platform).user.props" Condition="exists('$(UserRootDir)\Microsoft.Cpp.$(Platform).user.props')" Label="LocalAppDataPlatform" /> | |||
</ImportGroup> | |||
<ImportGroup Label="PropertySheets" Condition="'$(Configuration)|$(Platform)'=='Release|Win32'"> | |||
<Import Project="$(UserRootDir)\Microsoft.Cpp.$(Platform).user.props" Condition="exists('$(UserRootDir)\Microsoft.Cpp.$(Platform).user.props')" Label="LocalAppDataPlatform" /> | |||
</ImportGroup> | |||
<PropertyGroup Label="UserMacros" /> | |||
<PropertyGroup /> | |||
<ItemDefinitionGroup Condition="'$(Configuration)|$(Platform)'=='Debug|Win32'"> | |||
<ClCompile> | |||
<WarningLevel>Level3</WarningLevel> | |||
<Optimization>Disabled</Optimization> | |||
<SDLCheck>true</SDLCheck> | |||
<PreprocessorDefinitions>DLLProvider;%(PreprocessorDefinitions)</PreprocessorDefinitions> | |||
</ClCompile> | |||
<Link> | |||
<GenerateDebugInformation>true</GenerateDebugInformation> | |||
<ModuleDefinitionFile>Source.def</ModuleDefinitionFile> | |||
</Link> | |||
</ItemDefinitionGroup> | |||
<ItemDefinitionGroup Condition="'$(Configuration)|$(Platform)'=='Release|Win32'"> | |||
<ClCompile> | |||
<WarningLevel>Level3</WarningLevel> | |||
<Optimization>MaxSpeed</Optimization> | |||
<FunctionLevelLinking>true</FunctionLevelLinking> | |||
<IntrinsicFunctions>true</IntrinsicFunctions> | |||
<SDLCheck>true</SDLCheck> | |||
</ClCompile> | |||
<Link> | |||
<GenerateDebugInformation>true</GenerateDebugInformation> | |||
<EnableCOMDATFolding>true</EnableCOMDATFolding> | |||
<OptimizeReferences>true</OptimizeReferences> | |||
<ModuleDefinitionFile>Source.def</ModuleDefinitionFile> | |||
</Link> | |||
</ItemDefinitionGroup> | |||
<ItemGroup> | |||
<ClInclude Include="Modbus.h" /> | |||
</ItemGroup> | |||
<ItemGroup> | |||
<ClCompile Include="Modbus_Master.cpp" /> | |||
<ClCompile Include="Modbus_Salve.cpp" /> | |||
</ItemGroup> | |||
<ItemGroup> | |||
<None Include="Source.def" /> | |||
</ItemGroup> | |||
<Import Project="$(VCTargetsPath)\Microsoft.Cpp.targets" /> | |||
<ImportGroup Label="ExtensionTargets"> | |||
</ImportGroup> | |||
</Project> |
@@ -0,0 +1,35 @@ | |||
<?xml version="1.0" encoding="utf-8"?> | |||
<Project ToolsVersion="4.0" xmlns="http://schemas.microsoft.com/developer/msbuild/2003"> | |||
<ItemGroup> | |||
<Filter Include="源文件"> | |||
<UniqueIdentifier>{4FC737F1-C7A5-4376-A066-2A32D752A2FF}</UniqueIdentifier> | |||
<Extensions>cpp;c;cc;cxx;def;odl;idl;hpj;bat;asm;asmx</Extensions> | |||
</Filter> | |||
<Filter Include="头文件"> | |||
<UniqueIdentifier>{93995380-89BD-4b04-88EB-625FBE52EBFB}</UniqueIdentifier> | |||
<Extensions>h;hh;hpp;hxx;hm;inl;inc;xsd</Extensions> | |||
</Filter> | |||
<Filter Include="资源文件"> | |||
<UniqueIdentifier>{67DA6AB6-F800-4c08-8B7A-83BB121AAD01}</UniqueIdentifier> | |||
<Extensions>rc;ico;cur;bmp;dlg;rc2;rct;bin;rgs;gif;jpg;jpeg;jpe;resx;tiff;tif;png;wav;mfcribbon-ms</Extensions> | |||
</Filter> | |||
</ItemGroup> | |||
<ItemGroup> | |||
<ClInclude Include="Modbus.h"> | |||
<Filter>头文件</Filter> | |||
</ClInclude> | |||
</ItemGroup> | |||
<ItemGroup> | |||
<ClCompile Include="Modbus_Master.cpp"> | |||
<Filter>源文件</Filter> | |||
</ClCompile> | |||
<ClCompile Include="Modbus_Salve.cpp"> | |||
<Filter>源文件</Filter> | |||
</ClCompile> | |||
</ItemGroup> | |||
<ItemGroup> | |||
<None Include="Source.def"> | |||
<Filter>源文件</Filter> | |||
</None> | |||
</ItemGroup> | |||
</Project> |
@@ -0,0 +1,42 @@ | |||
#ifndef __MODBUS_H | |||
#define __MODBUS_H | |||
#ifdef DLLProvider | |||
#define DLL_EXPORT_IMPORT __declspec(dllexport) | |||
#else | |||
#define DLL_EXPORT_IMPORT __declspec(dllimport) | |||
#endif | |||
#include <stdio.h> | |||
#include <winsock2.h> | |||
#include <WS2tcpip.h> | |||
#include <vector> | |||
#include <string> | |||
#include <iostream> | |||
#include <algorithm> | |||
#include <tchar.h> | |||
#include <bitset> | |||
#pragma comment(lib,"ws2_32.lib") | |||
using namespace std; | |||
#define DEVICE_ID 0x01 //É豸ID | |||
#define Device_ID 0x09 | |||
#define MAX_Address 9999 | |||
#define MAX_NUMBER 300 | |||
enum Response_Type{ | |||
MSG_LEN_ERROR, | |||
MABP_ERROR, | |||
FUNCTION_CODE_ERROR, | |||
START_ADDRESS_ERROR, | |||
OPERATION_NUMBER_ERROR, | |||
NORMAL_RESPONSE, | |||
ABNORMAL_RESPONSE | |||
}; | |||
DLL_EXPORT_IMPORT int Analysis_Response_Message(UINT8 *Response_Message, UINT8 *Request_Message, int response_message_len); | |||
DLL_EXPORT_IMPORT int Create_TCP_Message(UINT8 *Message, int function_code, unsigned int operations_Number, unsigned int starting_address, string write_date); | |||
DLL_EXPORT_IMPORT bool Create_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message, DWORD read_len); | |||
#endif /* __MODBUS_H */ |
@@ -0,0 +1,198 @@ | |||
#include "Modbus.h" | |||
UINT16 Transmission_Indicator = 0x00; //事务号 | |||
/********************************************************************************************* | |||
* 功能 : 计算写入数据的字节数 | |||
* 描述 : 通过对应的功能码和操作数量计算对应的数据字节数 | |||
* 输入 : function_code 选择的功能码类型 operations_Number对应功能码类型的操作数量 | |||
* 输出 : Write_date_number 写入数据的字节数 | |||
*********************************************************************************************/ | |||
unsigned int Count_Write_date_number(int function_code, unsigned int operations_number) | |||
{ | |||
unsigned int write_date_number = 0; | |||
if (function_code == 0x01 || function_code == 0x03) | |||
return write_date_number; | |||
if (function_code == 0x0F) //读线圈 | |||
{ | |||
write_date_number = operations_number / 8; | |||
if (operations_number % 8) | |||
write_date_number++; | |||
} | |||
if (function_code == 0x10) | |||
write_date_number = operations_number * 2; | |||
return write_date_number; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 计算请求报文计算预期响应报文字节数 | |||
* 描述 : 通过对应的功能码和操作数量计算对应的数据字节数 | |||
* 输入 : Function_code 选择的功能码类型 Operations_Number对应功能码类型的操作数量 | |||
* 输出 : Respone_len 预期响应的数据字节数 | |||
*********************************************************************************************/ | |||
unsigned int Count_Respone_Len(int function_code, unsigned int operations_number) | |||
{ | |||
unsigned int respone_len = 0; | |||
if (function_code == 0x0F || function_code == 0x10) | |||
return respone_len; | |||
if (function_code == 0x01) //读线圈 | |||
{ | |||
respone_len = operations_number / 8; | |||
if (operations_number % 8) | |||
respone_len++; | |||
} | |||
if (function_code == 0x03) | |||
respone_len = operations_number * 2; | |||
return respone_len; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 检测响应报文长度 | |||
* 描述 : 对响应报文中存放长度字节进行判断和请求报文对比 | |||
* 输入 : Response_Message 响应报文 Request_Message 请求报文 Response_Message_len 接收到的数据长度 | |||
* 输出 : true 长度正常 false 长度异常 | |||
*********************************************************************************************/ | |||
bool Check_Response_Message_len(UINT8 *Response_Message, UINT8 *Request_Message, int response_message_len) | |||
{ | |||
if ((response_message_len - 6) != Response_Message[5]) | |||
return false; | |||
unsigned int operations_Number = Request_Message[10] << 8 | Request_Message[11]; | |||
unsigned int respone_Len = Count_Respone_Len(Request_Message[7], operations_Number); | |||
if (Request_Message[7] == 0x0F || Request_Message[7] == 0x10) | |||
if (response_message_len != 12) | |||
return false; | |||
if (Request_Message[7] == 0x01 || Request_Message[7] == 0x03) | |||
{ | |||
if (respone_Len + 9 != response_message_len) | |||
return false; | |||
if (respone_Len != Response_Message[8]) | |||
return false; | |||
} | |||
return true; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 判断响应报文是否可以正常解析 | |||
* 描述 : 通过长度和异常码等判定该响应报文是否可以解析 | |||
* 输入 : Response_Message 响应报文 Request_Message请求报文 Response_Message_len 响应报文长度 | |||
* 输出 : 响应数据类型 | |||
*********************************************************************************************/ | |||
int Analysis_Response_Message(UINT8 *Response_Message, UINT8 *Request_Message, int response_message_len) | |||
{ | |||
if (response_message_len < 9 || response_message_len > 260) | |||
return MSG_LEN_ERROR; | |||
for (int i = 0; i < 7; i++) | |||
{ | |||
if (i == 4 || i == 5) //后续字节长度 | |||
continue; | |||
if (Response_Message[i] != Request_Message[i]) //0 1 传输标识,2 3 协议标识,6设备ID | |||
return MABP_ERROR; //一旦不一致,判定为异常报文数据 | |||
} | |||
if (Response_Message[4] != 0x00) //4 固定0x00 | |||
return MABP_ERROR; | |||
if (Response_Message[7] == Request_Message[7] + 0x80)//先处理异常响应 | |||
{ | |||
if (response_message_len == 9) | |||
{ | |||
return ABNORMAL_RESPONSE; | |||
} | |||
else | |||
return MSG_LEN_ERROR; | |||
} | |||
if (Response_Message[7] != Request_Message[7]) //功能码判断 | |||
return FUNCTION_CODE_ERROR; | |||
if (Request_Message[7] == 0x0F || Request_Message[7] == 0x10) //0F 10 地址和操作数量判定 | |||
{ | |||
for (int j = 8; j < 10; j++) | |||
{ | |||
if (Request_Message[j] != Response_Message[j]) | |||
return START_ADDRESS_ERROR; | |||
} | |||
for (int j = 10; j < 12; j++) | |||
{ | |||
if (Request_Message[j] != Response_Message[j]) | |||
return OPERATION_NUMBER_ERROR; | |||
} | |||
} | |||
if (!Check_Response_Message_len(Response_Message, Request_Message, response_message_len)) | |||
return MSG_LEN_ERROR; | |||
return NORMAL_RESPONSE; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成MBAP报头 | |||
* 描述 : MBAP报文头的包括的内容: | |||
* +-------------+---------+--------+--------+------------------------------+ | |||
* | 域 | 长度 | 客户机 | 服务器 | 描述 | | |||
* +-------------+---------+--------+--------+------------------------------+ | |||
* |事务元标识符 | 2个字节 | 启动 | 复制 |请求/响应事务处理的识别码 | | |||
* +-------------+---------+--------+--------+------------------------------+ | |||
* |协议标识符 | 2个字节 | 启动 | 复制 |0=MODBUS 协议 | | |||
* +-------------+---------+--------+--------+------------------------------+ | |||
* | 长度 | 2个字节 | 启动 | 启动 |以下字节的数量 | | |||
* +-------------+---------+--------+--------+------------------------------+ | |||
* |单元标识符 | 1个字节 | 启动 | 复制 |连接的远程从站的识别码 | | |||
* 输入 : 无 | |||
* 输出 : MBAP报文头内容 | |||
*********************************************************************************************/ | |||
void Create_MBAP(UINT8 *Message, int function_code, unsigned int operations_number) | |||
{ | |||
Message[0] = Transmission_Indicator >> 8;//事务号 | |||
Message[1] = (UINT8)Transmission_Indicator; | |||
Transmission_Indicator++; | |||
Message[2] = 0x00; //Modbus协议标识 | |||
Message[3] = 0x00; | |||
Message[4] = 0x00;//后续字节长度 | |||
Message[5] = Count_Write_date_number(function_code, operations_number) + 0x06; | |||
if (function_code == 0x0F || function_code == 0x10)//0f/10功能码后续字节数多1 | |||
{ | |||
Message[5] = Message[5] + 1; | |||
} | |||
Message[6] = DEVICE_ID; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 字符串转UINT8类型 | |||
* 描述 : 根据写入数量和功能码类型输入相应的数据 | |||
* 输入 : *Message 消息帧存放的数组 Write_date 要转换的字符串 | |||
* Message_len消息帧数组的起始位置 | |||
* 输出 : Message_len 消息帧的长度 | |||
*********************************************************************************************/ | |||
int HexStringtoByte(UINT8 *Message, string write_date, int message_len, int function_code, unsigned int operations_Number) | |||
{ | |||
if (write_date.length() == 0) | |||
return message_len; | |||
Message[message_len] = Count_Write_date_number(function_code, operations_Number); | |||
message_len++; | |||
const char *b = write_date.c_str(); | |||
int temp = 0; | |||
for (unsigned int i = 0; i + 3 < write_date.length(); i = i + 3) | |||
{ | |||
sscanf_s(b + i, "%02X", &temp); | |||
Message[message_len] = (UINT8)temp; | |||
message_len++; | |||
} | |||
sscanf_s(b + write_date.length() - 2, "%02X", &temp); | |||
Message[message_len] = (UINT8)temp; | |||
return ++message_len; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成TCP模式下的消息帧 | |||
* 描述 : 根据要写入的数据生成消息帧 | |||
* 输入 : *Message 消息帧存放的数组 Write_date 写入数据的字符串 | |||
* Function_code 功能码 Operations_Number 操作数量 Starting_address起始地址 | |||
* 输出 : 消息帧的总长度 | |||
*********************************************************************************************/ | |||
int Create_TCP_Message(UINT8 *Message, int function_code, unsigned int operations_Number, unsigned int starting_address, string write_date) | |||
{ | |||
Create_MBAP(Message, function_code, operations_Number); | |||
Message[7] = function_code;//功能码 | |||
Message[8] = starting_address >> 8;//起始地址H | |||
Message[9] = starting_address;//起始地址L | |||
Message[10] = operations_Number >> 8;//操作数量H | |||
Message[11] = operations_Number;//操作数量L | |||
return HexStringtoByte(Message, write_date, 12, function_code, operations_Number); | |||
} |
@@ -0,0 +1,401 @@ | |||
#include "Modbus.h" | |||
bitset<MAX_Address> Coil_date; //0-9999 | |||
UINT16 Register[MAX_Address]; // 0-9999 | |||
unsigned int Response_Message_Len; | |||
unsigned int RTU_Enable = 1; | |||
/********************************************************************************************* | |||
* 功能 : 计算写入数据的字节数 | |||
* 描述 : 通过对应的功能码和操作数量计算对应的数据字节数 | |||
* 输入 : Function_code 选择的功能码类型 Operations_Number对应功能码类型的操作数量 | |||
* 输出 : Read_date_number 写入数据的字节数 | |||
*********************************************************************************************/ | |||
unsigned int Count_Read_date_number(int function_code, unsigned int operations_number) | |||
{ | |||
unsigned int read_date_number = 0; | |||
if (function_code == 0x01 || function_code == 0x0F) //读线圈 | |||
{ | |||
read_date_number = operations_number / 8; | |||
if (operations_number % 8) | |||
read_date_number++; | |||
} | |||
if (function_code == 0x03 || function_code == 0x10)//读寄存器 | |||
read_date_number = operations_number * 2; | |||
return read_date_number; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 计算CRC校验 | |||
* 描述 : 获取Modbus—CRC-16的校验数据 | |||
* 输入 : *Data 计算校验数据 CRC_Len 数据长度 | |||
* 返回值 : Ret_CRC_date CRC校验结果 | |||
**********************************************************************************************/ | |||
UINT16 CRC_16(UINT8 *data, unsigned int crc_len) | |||
{ | |||
UINT16 crc_date = 0XFFFF;//16位crc寄存器预置 | |||
UINT16 temp; | |||
unsigned int i = 0, j = 0; | |||
for (i = 0; i < crc_len; i++) | |||
{ | |||
temp = *data & 0X00FF;//将八位数据与CRC寄存器亦或 | |||
data++; | |||
crc_date ^= temp; | |||
for (j = 0; j < 8; j++) | |||
{ | |||
if (crc_date & 0X0001)//判断右移出的是不是1,如果是1则与多项式进行异或。 | |||
{ | |||
crc_date >>= 1; | |||
crc_date ^= 0XA001; | |||
} | |||
else | |||
{ | |||
crc_date >>= 1; | |||
} | |||
} | |||
} | |||
UINT16 ret_crc_date = crc_date >> 8; | |||
ret_crc_date = ret_crc_date | crc_date << 8; | |||
return ret_crc_date; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 初始化线圈和寄存器 | |||
* 描述 : 对线圈和寄存器数组赋值为全1 | |||
* 输入 : 无 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Init_Coil_Register(void) | |||
{ | |||
for (int i = 0; i < MAX_Address; i++) | |||
{ | |||
Coil_date[i] = 1; | |||
Register[i] = 0xFFFF; | |||
} | |||
} | |||
/********************************************************************************************* | |||
* 功能 : Bitset转UINT8类型 | |||
* 描述 : Bitset ==》UINT8 | |||
* 输入 : Bitset_Address Bitset的起始地址 Read_Number 要读取的位数 | |||
* 返回值 : Date 转换后的UNIT8数据 | |||
**********************************************************************************************/ | |||
UINT8 Bitset_to_Uint8(unsigned int bitset_address, unsigned int read_number) | |||
{ | |||
UINT8 date = 0x00; | |||
if (read_number >= 8) | |||
{ | |||
unsigned int len = bitset_address + 7; | |||
for (unsigned int i = 0; i < 8; i++) | |||
{ | |||
date = date << 1; | |||
date = date | (int)Coil_date[len--]; | |||
} | |||
} | |||
else | |||
{ | |||
unsigned int len = bitset_address + read_number - 1; | |||
for (unsigned int i = 0; i < read_number; i++) | |||
{ | |||
date = date << 1; | |||
date = date | (int)Coil_date[len--]; | |||
} | |||
} | |||
return date; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成异常码响应报文 | |||
* 描述 : 对不支持的功能码生成对应的异常响应报文 | |||
* 输入 : *Requst_Message 请求报文 *Response_Message响应报文 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Create_Abnormal_Code_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message, UINT8 abnormal_code) | |||
{ | |||
Response_Message[0] = Device_ID; | |||
Response_Message[1] = Requst_Message[1] + 0x80; | |||
Response_Message[2] = abnormal_code; | |||
Response_Message_Len = 3; | |||
UINT16 crc_date = CRC_16(Response_Message, 3); | |||
Response_Message[3] = crc_date >> 8;//CRC_H | |||
Response_Message[4] = (UINT8)crc_date; //CRC_L | |||
Response_Message_Len = 5; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成0x01功能码响应报文 | |||
* 描述 : 通过判断地址范围生成0x01对应的响应报文 | |||
* 输入 : *Requst_Message 请求报文 *Response_Message响应报文 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Create_0x01_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message) | |||
{ | |||
unsigned int start_Address = Requst_Message[2] << 8 | Requst_Message[3]; | |||
unsigned int address_range = start_Address + (Requst_Message[4] << 8 | Requst_Message[5]); | |||
if (address_range < MAX_Address)//判断地址是否超限 | |||
{ | |||
unsigned int read_number = Requst_Message[4] << 8 | Requst_Message[5];//要读取的位数 | |||
unsigned int read_len = Count_Read_date_number(Requst_Message[1], read_number); //要读取的字节数 | |||
for (unsigned int i = 3; i < read_len + 3; i++) | |||
{ | |||
Response_Message[i] = Bitset_to_Uint8(start_Address, read_number); | |||
start_Address += 8; | |||
read_number -= 8; | |||
} | |||
Response_Message[0] = Device_ID; | |||
Response_Message[1] = Requst_Message[1]; | |||
Response_Message[2] = read_len; //响应报文中的后续字节数 | |||
UINT16 crc_date = CRC_16(Response_Message, read_len + 3); | |||
Response_Message_Len = read_len + 2 + 3; | |||
Response_Message[Response_Message_Len - 2] = crc_date >> 8;//CRC_H | |||
Response_Message[Response_Message_Len - 1] = (UINT8)crc_date; //CRC_L | |||
} | |||
else | |||
{ | |||
Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x02); | |||
} | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成0x03功能码响应报文 | |||
* 描述 : 通过判断地址范围生成0x03对应的响应报文 | |||
* 输入 : *Requst_Message 请求报文 *Response_Message响应报文 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Create_0x03_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message) | |||
{ | |||
unsigned int start_Address = Requst_Message[2] << 8 | Requst_Message[3]; | |||
unsigned int address_range = start_Address + (Requst_Message[4] << 8 | Requst_Message[5]); | |||
if (address_range < MAX_Address) //判断地址是否超限 | |||
{ | |||
unsigned int read_number = Requst_Message[4] << 8 | Requst_Message[5];//要读取的寄存器数量 | |||
unsigned int read_len = Count_Read_date_number(Requst_Message[1], read_number); //要读取的字节数 | |||
for (unsigned int i = 3; i < read_len + 3; i = i + 2) | |||
{ | |||
Response_Message[i] = Register[start_Address] >> 8; | |||
Response_Message[i + 1] = (UINT8)Register[start_Address]; | |||
start_Address += 1; | |||
} | |||
Response_Message[0] = Device_ID; | |||
Response_Message[1] = Requst_Message[1]; | |||
Response_Message[2] = read_len; //响应报文中的后续字节数 | |||
UINT16 crc_date = CRC_16(Response_Message, read_len + 3); | |||
Response_Message_Len = read_len + 2 + 3; | |||
Response_Message[Response_Message_Len - 2] = crc_date >> 8;//CRC_H | |||
Response_Message[Response_Message_Len - 1] = (UINT8)crc_date; //CRC_L | |||
} | |||
else //地址超限 | |||
{ | |||
Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x02); | |||
} | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 写入线圈 | |||
* 描述 : 将数据写入线圈中 | |||
* 输入 : Write_date_Message 要写入的数据 Write_Number要写入的位数 Start_Address起始地址 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Write_Coil_date(UINT8 write_date_message, unsigned int write_number, unsigned int start_address) | |||
{ | |||
if (write_number >= 8) | |||
{ | |||
for (unsigned int i = start_address; i < start_address + 8; i++) | |||
{ | |||
Coil_date[i] = write_date_message & 1; | |||
write_date_message = write_date_message >> 1; | |||
} | |||
} | |||
else | |||
{ | |||
for (unsigned int i = start_address; i < start_address + write_number; i++) | |||
{ | |||
Coil_date[i] = write_date_message & 1; | |||
write_date_message = write_date_message >> 1; | |||
} | |||
} | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成0x0F功能码响应报文 | |||
* 描述 : 通过判断地址范围生成0x0F对应的响应报文 | |||
* 输入 : *Requst_Message 请求报文 *Response_Message响应报文 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Create_0x0F_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message) | |||
{ | |||
unsigned int start_Address = Requst_Message[2] << 8 | Requst_Message[3]; | |||
unsigned int address_range = start_Address + (Requst_Message[4] << 8 | Requst_Message[5]); | |||
if (address_range < MAX_Address)//判断地址是否超限 | |||
{ | |||
unsigned int write_Number = Requst_Message[4] << 8 | Requst_Message[5];//要写入的位数 | |||
for (int i = 7; i < Requst_Message[6] + 7; i++)//执行写入线圈操作 | |||
{ | |||
Write_Coil_date(Requst_Message[i], write_Number, start_Address); | |||
write_Number -= 8; | |||
start_Address += 8; | |||
} | |||
Response_Message[0] = Device_ID; | |||
Response_Message[1] = Requst_Message[1]; | |||
Response_Message[2] = Requst_Message[2]; | |||
Response_Message[3] = Requst_Message[3]; | |||
Response_Message[4] = Requst_Message[4]; | |||
Response_Message[5] = Requst_Message[5]; | |||
UINT16 crc_date = CRC_16(Response_Message, 6); | |||
Response_Message[6] = crc_date >> 8;//CRC_H | |||
Response_Message[7] = (UINT8)crc_date; //CRC_L | |||
Response_Message_Len = 8; | |||
} | |||
else //地址超限 | |||
{ | |||
Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x02); | |||
} | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成0x10功能码响应报文 | |||
* 描述 : 通过判断地址范围生成0x10对应的响应报文 | |||
* 输入 : *Requst_Message 请求报文 *Response_Message响应报文 | |||
* 返回值 : 无 | |||
**********************************************************************************************/ | |||
void Create_0x10_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message) | |||
{ | |||
unsigned int start_Address = Requst_Message[2] << 8 | Requst_Message[3]; | |||
unsigned int address_range = start_Address + (Requst_Message[4] << 8 | Requst_Message[5]); | |||
if (address_range < MAX_Address)//判断地址是否超限 | |||
{ | |||
for (int i = 7; i < Requst_Message[6] + 7; i = i + 2)//执行写入寄存器操作 | |||
{ | |||
Register[start_Address] = Requst_Message[i] << 8 | Requst_Message[i + 1]; | |||
start_Address++; | |||
} | |||
Response_Message[0] = Device_ID; | |||
Response_Message[1] = Requst_Message[1]; | |||
Response_Message[2] = Requst_Message[2]; | |||
Response_Message[3] = Requst_Message[3]; | |||
Response_Message[4] = Requst_Message[4]; | |||
Response_Message[5] = Requst_Message[5]; | |||
UINT16 crc_date = CRC_16(Response_Message, 6); | |||
Response_Message[6] = crc_date >> 8;//CRC_H | |||
Response_Message[7] = (UINT8)crc_date; //CRC_L | |||
Response_Message_Len = 8; | |||
} | |||
else //地址超限 | |||
{ | |||
Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x02); | |||
} | |||
} | |||
/********************************************************************************************* | |||
* 功能 : CRC校验 | |||
* 描述 : 对请求报文中的数据进行CRC校验 | |||
* 输入 : *Requst_Message 请求报文 Read_len 接收到到的字节数 | |||
* 返回值 : true CRC校验通过 | |||
* false CRC校验不通过 | |||
**********************************************************************************************/ | |||
bool Check_Requst_Message_CRC(UINT8 *Requst_Message, DWORD read_len) | |||
{ | |||
UINT16 crc_data = CRC_16(Requst_Message, read_len - 2); | |||
UINT16 message_crc = Requst_Message[read_len - 2] << 8 | Requst_Message[read_len - 1]; | |||
if (crc_data != message_crc) | |||
return false; | |||
return true; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 异常码03判定--请求报文长度校验 | |||
* 描述 : 对请求报文的字节长度进行计算校验 | |||
* 输入 : *Requst_Message 请求报文 Read_len 接收到到的字节数 | |||
* 返回值 : true 长度校验通过 | |||
* false 长度校验不通过 | |||
**********************************************************************************************/ | |||
bool Check_Requst_Message_Len(UINT8 *Requst_Message, DWORD read_len) | |||
{ | |||
if (Requst_Message[1] == 0x01 || Requst_Message[1] == 0x03) | |||
{ | |||
if (read_len != 8) | |||
return false; | |||
} | |||
if (Requst_Message[1] == 0x0F || Requst_Message[1] == 0x10) | |||
{ | |||
unsigned int number = Requst_Message[4] << 8 | Requst_Message[5]; | |||
unsigned int count_len = Count_Read_date_number(Requst_Message[1], number); | |||
if (Requst_Message[6] != count_len || read_len != count_len + 9) | |||
return false; | |||
} | |||
return true; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 异常码03判定--请求报文中的操作数量判定 | |||
* 描述 : 对请求报文中的操作数量进行判定 | |||
* 输入 : *Requst_Message 请求报文 Read_len 接收到到的字节数 | |||
* 返回值 : true 校验通过 | |||
* false 校验不通过 | |||
**********************************************************************************************/ | |||
bool Check_Operation_Number_Requst_Message(UINT8 *Requst_Message) | |||
{ | |||
unsigned int operation_number = Requst_Message[4] << 8 | Requst_Message[5]; | |||
if (Requst_Message[1] == 0x01) | |||
{ | |||
if (operation_number == 0 || operation_number > 2000) | |||
return false; | |||
} | |||
if (Requst_Message[1] == 0x03) | |||
{ | |||
if (operation_number == 0 || operation_number > 125) | |||
return false; | |||
} | |||
if (Requst_Message[1] == 0x0F) | |||
{ | |||
if (operation_number < 1 || operation_number > 1968) | |||
return false; | |||
} | |||
if (Requst_Message[1] == 0x10) | |||
{ | |||
if (operation_number < 1 || operation_number > 123) | |||
return false; | |||
} | |||
return true; | |||
} | |||
/********************************************************************************************* | |||
* 功能 : 生成响应报文 | |||
* 描述 : 检查设备请求报文来生成对应功能的响应报文 | |||
* 输入 : *Requst_Message 请求报文 *Response_Message响应报文 | |||
* 返回值 : true 生成响应报文 | |||
* false 不生成响应报文 | |||
**********************************************************************************************/ | |||
bool Create_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message, DWORD read_len) | |||
{ | |||
if (Requst_Message[0] != Device_ID) //检查设备ID一致 | |||
return false; | |||
if (read_len < 8 || read_len > 256) | |||
return false; | |||
if (!Check_Requst_Message_CRC(Requst_Message, read_len))//CRC校验报文是否正确 | |||
return false; | |||
if (RTU_Enable == 0) | |||
{ | |||
Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x04); | |||
return true; | |||
} | |||
if (!Check_Requst_Message_Len(Requst_Message, read_len) || !Check_Operation_Number_Requst_Message(Requst_Message))//检查请求报文长度是否正确 | |||
{ | |||
Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x03); | |||
return true; | |||
} | |||
switch (Requst_Message[1]) | |||
{ | |||
case 0x01:Create_0x01_Response_Message(Requst_Message, Response_Message); break; | |||
case 0x03:Create_0x03_Response_Message(Requst_Message, Response_Message); break; | |||
case 0x0F:Create_0x0F_Response_Message(Requst_Message, Response_Message); break; | |||
case 0x10:Create_0x10_Response_Message(Requst_Message, Response_Message); break; | |||
default: Create_Abnormal_Code_Response_Message(Requst_Message, Response_Message, 0x01); | |||
} | |||
return true; | |||
} |
@@ -0,0 +1,5 @@ | |||
LIBRARY Master_Salve_Dll | |||
EXPORTS | |||
Analysis_Response_Message @1 | |||
Create_TCP_Message @2 | |||
Create_Response_Message @3 |
@@ -11,6 +11,8 @@ Project("{8BC9CEB8-8B4A-11D0-8D11-00A0C91BC942}") = "TCP_Master_test", "TCP_Mast | |||
EndProject | |||
Project("{8BC9CEB8-8B4A-11D0-8D11-00A0C91BC942}") = "RTU_Salve_test", "RTU_Salve_test\RTU_Salve_test.vcxproj", "{4443732F-F883-4E71-ACDD-E5E777C63728}" | |||
EndProject | |||
Project("{8BC9CEB8-8B4A-11D0-8D11-00A0C91BC942}") = "Master_Salve_DLL", "Master_Salve_DLL\Master_Salve_DLL.vcxproj", "{CB8E0444-CD69-430B-8ACF-8083D140A65F}" | |||
EndProject | |||
Global | |||
GlobalSection(SolutionConfigurationPlatforms) = preSolution | |||
Debug|Win32 = Debug|Win32 | |||
@@ -33,6 +35,10 @@ Global | |||
{4443732F-F883-4E71-ACDD-E5E777C63728}.Debug|Win32.Build.0 = Debug|Win32 | |||
{4443732F-F883-4E71-ACDD-E5E777C63728}.Release|Win32.ActiveCfg = Release|Win32 | |||
{4443732F-F883-4E71-ACDD-E5E777C63728}.Release|Win32.Build.0 = Release|Win32 | |||
{CB8E0444-CD69-430B-8ACF-8083D140A65F}.Debug|Win32.ActiveCfg = Debug|Win32 | |||
{CB8E0444-CD69-430B-8ACF-8083D140A65F}.Debug|Win32.Build.0 = Debug|Win32 | |||
{CB8E0444-CD69-430B-8ACF-8083D140A65F}.Release|Win32.ActiveCfg = Release|Win32 | |||
{CB8E0444-CD69-430B-8ACF-8083D140A65F}.Release|Win32.Build.0 = Release|Win32 | |||
EndGlobalSection | |||
GlobalSection(SolutionProperties) = preSolution | |||
HideSolutionNode = FALSE | |||