|
@@ -4,6 +4,7 @@ char read_buf[MAX_NUMBER]; |
|
|
|
|
|
|
|
|
bitset<MAX_Address> Coil_date; //0-9999 |
|
|
bitset<MAX_Address> Coil_date; //0-9999 |
|
|
UINT16 Register[MAX_Address]; // 0-9999 |
|
|
UINT16 Register[MAX_Address]; // 0-9999 |
|
|
|
|
|
unsigned int Response_Message_Len; |
|
|
|
|
|
|
|
|
/********************************************************************************************* |
|
|
/********************************************************************************************* |
|
|
* 功能 : 初始化线圈和寄存器 |
|
|
* 功能 : 初始化线圈和寄存器 |
|
@@ -32,7 +33,7 @@ UINT8 Bitset_to_Uint8(unsigned int Bitset_Address, unsigned int Read_Number) |
|
|
if (Read_Number >= 8) |
|
|
if (Read_Number >= 8) |
|
|
{ |
|
|
{ |
|
|
unsigned int len = Bitset_Address + 8; |
|
|
unsigned int len = Bitset_Address + 8; |
|
|
for (int i = 0; i < 8; i++) |
|
|
|
|
|
|
|
|
for (unsigned int i = 0; i < 8; i++) |
|
|
{ |
|
|
{ |
|
|
Date = Date << 1 | (int)Coil_date[len--]; |
|
|
Date = Date << 1 | (int)Coil_date[len--]; |
|
|
} |
|
|
} |
|
@@ -40,7 +41,7 @@ UINT8 Bitset_to_Uint8(unsigned int Bitset_Address, unsigned int Read_Number) |
|
|
else |
|
|
else |
|
|
{ |
|
|
{ |
|
|
unsigned int len = Bitset_Address + Read_Number-1; |
|
|
unsigned int len = Bitset_Address + Read_Number-1; |
|
|
for (int i = 0; i < Read_Number; i++) |
|
|
|
|
|
|
|
|
for (unsigned int i = 0; i < Read_Number; i++) |
|
|
{ |
|
|
{ |
|
|
Date = Date << 1 | (int)Coil_date[len--]; |
|
|
Date = Date << 1 | (int)Coil_date[len--]; |
|
|
} |
|
|
} |
|
@@ -70,13 +71,21 @@ void Create_0x01_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message |
|
|
} |
|
|
} |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[1] = Requst_Message[1]; |
|
|
Response_Message[1] = Requst_Message[1]; |
|
|
Response_Message[2] = Read_Len+2; //响应报文中的后续字节数 |
|
|
|
|
|
|
|
|
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 //地址超限 |
|
|
|
|
|
|
|
|
else |
|
|
{ |
|
|
{ |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[2] = 0x02; |
|
|
|
|
|
|
|
|
Response_Message[2] = 0x02;//地址超限异常码02 |
|
|
|
|
|
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; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
@@ -102,13 +111,21 @@ void Create_0x03_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message |
|
|
} |
|
|
} |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[1] = Requst_Message[1]; |
|
|
Response_Message[1] = Requst_Message[1]; |
|
|
Response_Message[2] = Read_Len + 2; //响应报文中的后续字节数 |
|
|
|
|
|
|
|
|
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 //地址超限 |
|
|
else //地址超限 |
|
|
{ |
|
|
{ |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[2] = 0x02; |
|
|
Response_Message[2] = 0x02; |
|
|
|
|
|
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; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
@@ -125,7 +142,7 @@ void Write_Coil_date(UINT8 Write_date_Message, unsigned int Write_Number, unsign |
|
|
for (unsigned int i = Start_Address; i < Start_Address+8; i++) |
|
|
for (unsigned int i = Start_Address; i < Start_Address+8; i++) |
|
|
{ |
|
|
{ |
|
|
Coil_date[i] = Write_date_Message & 1; |
|
|
Coil_date[i] = Write_date_Message & 1; |
|
|
Write_date_Message >> 1; |
|
|
|
|
|
|
|
|
Write_date_Message = Write_date_Message >> 1; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
else |
|
|
else |
|
@@ -133,7 +150,7 @@ void Write_Coil_date(UINT8 Write_date_Message, unsigned int Write_Number, unsign |
|
|
for (unsigned int i = Start_Address; i < Start_Address + Write_Number; i++) |
|
|
for (unsigned int i = Start_Address; i < Start_Address + Write_Number; i++) |
|
|
{ |
|
|
{ |
|
|
Coil_date[i] = Write_date_Message & 1; |
|
|
Coil_date[i] = Write_date_Message & 1; |
|
|
Write_date_Message >> 1; |
|
|
|
|
|
|
|
|
Write_date_Message = Write_date_Message >> 1; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
@@ -151,7 +168,7 @@ void Create_0x0F_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message |
|
|
if (Address_range < MAX_Address)//判断地址是否超限 |
|
|
if (Address_range < MAX_Address)//判断地址是否超限 |
|
|
{ |
|
|
{ |
|
|
unsigned int Write_Number = Requst_Message[4] << 8 | Requst_Message[5];//要写入的位数 |
|
|
unsigned int Write_Number = Requst_Message[4] << 8 | Requst_Message[5];//要写入的位数 |
|
|
for (unsigned int i = 7; i < Requst_Message[6]+7; i++)//执行写入线圈操作 |
|
|
|
|
|
|
|
|
for (int i = 7; i < Requst_Message[6]+7; i++)//执行写入线圈操作 |
|
|
{ |
|
|
{ |
|
|
Write_Coil_date(Requst_Message[i], Write_Number, Start_Address); |
|
|
Write_Coil_date(Requst_Message[i], Write_Number, Start_Address); |
|
|
Write_Number -= 8; |
|
|
Write_Number -= 8; |
|
@@ -163,12 +180,21 @@ void Create_0x0F_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message |
|
|
Response_Message[3] = Requst_Message[3]; |
|
|
Response_Message[3] = Requst_Message[3]; |
|
|
Response_Message[4] = Requst_Message[4]; |
|
|
Response_Message[4] = Requst_Message[4]; |
|
|
Response_Message[5] = Requst_Message[5]; |
|
|
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 //地址超限 |
|
|
else //地址超限 |
|
|
{ |
|
|
{ |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[2] = 0x02; |
|
|
Response_Message[2] = 0x02; |
|
|
|
|
|
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; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
@@ -185,7 +211,7 @@ void Create_0x10_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message |
|
|
if (Address_range < MAX_Address)//判断地址是否超限 |
|
|
if (Address_range < MAX_Address)//判断地址是否超限 |
|
|
{ |
|
|
{ |
|
|
unsigned int Write_Number = Requst_Message[4] << 8 | Requst_Message[5];//要写入的寄存器个数 |
|
|
unsigned int Write_Number = Requst_Message[4] << 8 | Requst_Message[5];//要写入的寄存器个数 |
|
|
for (unsigned int i = 7; i < Requst_Message[6] + 7; i = i + 2)//执行写入寄存器操作 |
|
|
|
|
|
|
|
|
for (int i = 7; i < Requst_Message[6] + 7; i = i + 2)//执行写入寄存器操作 |
|
|
{ |
|
|
{ |
|
|
Register[Start_Address] = Requst_Message[i] << 8 | Requst_Message[i+1]; |
|
|
Register[Start_Address] = Requst_Message[i] << 8 | Requst_Message[i+1]; |
|
|
Start_Address++; |
|
|
Start_Address++; |
|
@@ -196,12 +222,20 @@ void Create_0x10_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message |
|
|
Response_Message[3] = Requst_Message[3]; |
|
|
Response_Message[3] = Requst_Message[3]; |
|
|
Response_Message[4] = Requst_Message[4]; |
|
|
Response_Message[4] = Requst_Message[4]; |
|
|
Response_Message[5] = Requst_Message[5]; |
|
|
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 //地址超限 |
|
|
else //地址超限 |
|
|
{ |
|
|
{ |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[0] = Device_ID; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[1] = Requst_Message[1] + 0x80; |
|
|
Response_Message[2] = 0x02; |
|
|
Response_Message[2] = 0x02; |
|
|
|
|
|
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; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
@@ -224,11 +258,21 @@ void Create_Abnormal_Function_Code_Response_Message(UINT8 *Requst_Message, UINT8 |
|
|
* 返回值 : true 生成响应报文 |
|
|
* 返回值 : true 生成响应报文 |
|
|
* false 不生成响应报文 |
|
|
* false 不生成响应报文 |
|
|
**********************************************************************************************/ |
|
|
**********************************************************************************************/ |
|
|
bool Create_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
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; |
|
|
|
|
|
} |
|
|
|
|
|
bool Create_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message, DWORD Read_len) |
|
|
{ |
|
|
{ |
|
|
|
|
|
if (!Check_Requst_Message_CRC(Requst_Message, Read_len))//CRC校验报文是否正确 |
|
|
|
|
|
return false; |
|
|
if (Requst_Message[0] != Device_ID) //检查设备ID一致 |
|
|
if (Requst_Message[0] != Device_ID) //检查设备ID一致 |
|
|
return false; |
|
|
return false; |
|
|
|
|
|
|
|
|
switch (Requst_Message[1]) |
|
|
switch (Requst_Message[1]) |
|
|
{ |
|
|
{ |
|
|
case 0x01:Create_0x01_Response_Message(Requst_Message, Response_Message); break; |
|
|
case 0x01:Create_0x01_Response_Message(Requst_Message, Response_Message); break; |
|
@@ -242,44 +286,42 @@ bool Create_Response_Message(UINT8 *Requst_Message, UINT8 *Response_Message) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int test(void) |
|
|
|
|
|
|
|
|
int Modbus_RTU_Salve(void) |
|
|
{ |
|
|
{ |
|
|
string COMM; |
|
|
|
|
|
cin >> COMM; |
|
|
|
|
|
HANDLE Handle_Com = Init_COM((LPCTSTR)COMM.c_str(), 9600, 8, 0, 1); |
|
|
|
|
|
|
|
|
string COMM = Input_COMM(); |
|
|
|
|
|
unsigned int Baud_Rate = Input_Baud_Rate(); |
|
|
|
|
|
BYTE Date_Bits = Input_Date_Bits(); |
|
|
|
|
|
BYTE Stop_Bits = Input_Stop_Bits(Date_Bits); |
|
|
|
|
|
BYTE Parity = Input_Parity(); |
|
|
|
|
|
|
|
|
|
|
|
UINT8 Requst_Message[MAX_NUMBER]; |
|
|
|
|
|
UINT8 Response_Message[MAX_NUMBER]; |
|
|
|
|
|
HANDLE Handle_Com = Init_COM((LPCTSTR)COMM.c_str(), Baud_Rate, Date_Bits, Stop_Bits, Parity); |
|
|
if (Handle_Com == INVALID_HANDLE_VALUE) |
|
|
if (Handle_Com == INVALID_HANDLE_VALUE) |
|
|
{ |
|
|
{ |
|
|
cout << "初始化串口失败" << endl; |
|
|
cout << "初始化串口失败" << endl; |
|
|
getchar(); |
|
|
getchar(); |
|
|
return 0; |
|
|
return 0; |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
char write_buf[MAX_NUMBER]; |
|
|
|
|
|
memset(write_buf, 0, MAX_NUMBER); |
|
|
|
|
|
DWORD dwRead; |
|
|
|
|
|
|
|
|
Init_Coil_Register(); |
|
|
|
|
|
DWORD Read_len; |
|
|
while (true) |
|
|
while (true) |
|
|
{ |
|
|
{ |
|
|
//RTU主站,生成并发送请求,计时,读取响应报文,先发送后接收 |
|
|
|
|
|
//生成请求报文 |
|
|
|
|
|
//发送请求报文 |
|
|
|
|
|
|
|
|
|
|
|
PurgeComm(Handle_Com, PURGE_RXABORT | PURGE_TXCLEAR | PURGE_RXCLEAR | PURGE_TXABORT);//清除缓存 |
|
|
PurgeComm(Handle_Com, PURGE_RXABORT | PURGE_TXCLEAR | PURGE_RXCLEAR | PURGE_TXABORT);//清除缓存 |
|
|
while (1) |
|
|
|
|
|
|
|
|
BOOL Read_flage = ReadFile(Handle_Com, Requst_Message, 256, &Read_len, NULL); //阻塞等待接收请求报文 |
|
|
|
|
|
if (Read_flage && (Read_len > 0)) |
|
|
{ |
|
|
{ |
|
|
if (true == SendData(Handle_Com, "ok", 2)) |
|
|
|
|
|
|
|
|
if (Create_Response_Message(Requst_Message, Response_Message, Read_len)) |
|
|
{ |
|
|
{ |
|
|
cout << "发送请求报文成功" << endl; |
|
|
|
|
|
break; |
|
|
|
|
|
|
|
|
while (SendData(Handle_Com, (char*)Response_Message, Response_Message_Len)) |
|
|
|
|
|
{ |
|
|
|
|
|
printf("发送失败,重新发送"); |
|
|
|
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
else |
|
|
|
|
|
continue; |
|
|
} |
|
|
} |
|
|
BOOL bReadOK = ReadFile(Handle_Com, read_buf, 256, &dwRead, NULL); |
|
|
|
|
|
if (bReadOK && (dwRead > 0)) |
|
|
|
|
|
{ |
|
|
|
|
|
read_buf[dwRead] = '\0'; |
|
|
|
|
|
printf("收到响应:%s \r\n", read_buf); |
|
|
|
|
|
} |
|
|
|
|
|
else |
|
|
|
|
|
cout << "loss" << endl; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
} |
|
|
CloseHandle(Handle_Com); |
|
|
CloseHandle(Handle_Com); |
|
|
getchar(); |
|
|
getchar(); |
|
|