5 changed files with 374 additions and 3 deletions
-
4.gitignore
-
4.settings/language.settings.xml
-
1tools/build.bat
-
368tools/temperature_sensor_data_parse.cpp
-
BINtools/黄金温度485数据解析程序V2.exe
@ -1,2 +1,4 @@ |
|||||
Debug |
Debug |
||||
Release |
|
||||
|
Release |
||||
|
tools/log.txt |
||||
|
tools/.vscode |
||||
@ -0,0 +1 @@ |
|||||
|
g++ -static -static-libgcc -static-libstdc++ -lwsock32 -lstdc++ .\temperature_sensor_data_parse.cpp -o temperature_sensor_data_parse.exe |
||||
@ -0,0 +1,368 @@ |
|||||
|
#pragma comment(lib, "ws2_32.lib")
|
||||
|
#include <winsock2.h>
|
||||
|
|
||||
|
#include <fstream>
|
||||
|
#include <functional>
|
||||
|
#include <iostream>
|
||||
|
#include <list>
|
||||
|
#include <map>
|
||||
|
#include <memory>
|
||||
|
#include <mutex>
|
||||
|
#include <set>
|
||||
|
#include <sstream>
|
||||
|
#include <string>
|
||||
|
#include <thread>
|
||||
|
#include <vector>
|
||||
|
//
|
||||
|
#include <Windows.h>
|
||||
|
//
|
||||
|
using namespace std; |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* 宏定义 * |
||||
|
***********************************************************************************************************************/ |
||||
|
#define RX_OVERTIME_MS 30 // 之所以设置成10ms，目的是为了能够监听到回执包
|
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* 日志 * |
||||
|
***********************************************************************************************************************/ |
||||
|
ofstream* logfile; |
||||
|
|
||||
|
/**
|
||||
|
* @brief 写日志到文件中 |
||||
|
*/ |
||||
|
bool log_file_init() { |
||||
|
// 创建日志文件
|
||||
|
logfile = new ofstream("log.txt", ios::app); |
||||
|
if (logfile == NULL) { |
||||
|
printf("创建日志文件失败\n"); |
||||
|
return false; |
||||
|
} |
||||
|
return true; |
||||
|
} |
||||
|
|
||||
|
void log(const char* fmt, ...) { |
||||
|
char buf[1024] = {0}; |
||||
|
va_list args; |
||||
|
va_start(args, fmt); |
||||
|
vsprintf(buf, fmt, args); |
||||
|
va_end(args); |
||||
|
cout << buf; |
||||
|
} |
||||
|
|
||||
|
void logd(const char* fmt, ...) { |
||||
|
char buf[1024] = {0}; |
||||
|
va_list args; |
||||
|
va_start(args, fmt); |
||||
|
vsprintf(buf, fmt, args); |
||||
|
va_end(args); |
||||
|
if (logfile) { |
||||
|
*logfile << buf; |
||||
|
logfile->flush(); |
||||
|
} |
||||
|
cout << buf; |
||||
|
} |
||||
|
|
||||
|
#define LOG(fmt, ...) log("[%08d] INFO : " fmt "\n", GetTickCount(), ##__VA_ARGS__);
|
||||
|
#define LOGD(fmt, ...) logd("[%08d] INFO : " fmt "\n", GetTickCount(), ##__VA_ARGS__);
|
||||
|
|
||||
|
string hextostr(const char* data, size_t len) { |
||||
|
string ret; |
||||
|
for (size_t i = 0; i < len; i++) { |
||||
|
char buf[20] = {0}; |
||||
|
sprintf(buf, "%02x", (uint8_t)data[i]); |
||||
|
ret += buf; |
||||
|
} |
||||
|
return ret; |
||||
|
} |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* MODBUS * |
||||
|
***********************************************************************************************************************/ |
||||
|
|
||||
|
static const uint8_t auchCRCHi[] = {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}; |
||||
|
// CRC低位字节值表
|
||||
|
static const uint8_t auchCRCLo[] = { // CRC_16低8位数据区
|
||||
|
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}; |
||||
|
|
||||
|
/*CRC16查表计算函数*/ |
||||
|
|
||||
|
uint16_t modbus_gen_crc16(uint8_t* puckMsg, uint8_t usDataLen) { |
||||
|
volatile uint8_t uchCRCHi = 0xFF; // 高CRC字节初始化
|
||||
|
volatile uint8_t uchCRCLo = 0xFF; // 低CRC 字节初始化
|
||||
|
volatile uint32_t uIndex; // CRC循环中的索引
|
||||
|
// 传输消息缓冲区
|
||||
|
while (usDataLen--) { |
||||
|
// 计算CRC
|
||||
|
uIndex = uchCRCLo ^ *puckMsg++; |
||||
|
uchCRCLo = uchCRCHi ^ auchCRCHi[uIndex]; |
||||
|
uchCRCHi = auchCRCLo[uIndex]; |
||||
|
} |
||||
|
// 返回结果，高位在前
|
||||
|
return (uchCRCLo << 8 | uchCRCHi); |
||||
|
} |
||||
|
|
||||
|
void modbus_pack_crc_to_packet(uint8_t* puckMsg, uint8_t packetlen) { |
||||
|
uint16_t crc = modbus_gen_crc16(puckMsg, packetlen - 2); |
||||
|
puckMsg[packetlen - 2] = crc >> 8; |
||||
|
puckMsg[packetlen - 1] = crc; |
||||
|
} |
||||
|
|
||||
|
bool modbus_checkcrc16(uint8_t* message, uint8_t length) { return (modbus_gen_crc16(message, length) == 0x00) ? true : false; } |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* 串口 * |
||||
|
***********************************************************************************************************************/ |
||||
|
unique_ptr<thread> serial_listen_thread; |
||||
|
unique_ptr<thread> serial_parse_thread; |
||||
|
mutex rx_lock_; |
||||
|
uint8_t serial_rxcache[1024] = {0}; |
||||
|
uint8_t serial_rxlen = 0; |
||||
|
HANDLE serial_CommHandler; |
||||
|
uint32_t serial_last_rx_data_ticket; |
||||
|
|
||||
|
static void serial_on_data(const char* data, size_t len); |
||||
|
int serial_receive(uint8_t* rxbuf, int rxbufsize) { |
||||
|
COMMTIMEOUTS TimeOuts; |
||||
|
GetCommTimeouts(serial_CommHandler, &TimeOuts); |
||||
|
TimeOuts.ReadIntervalTimeout = 0; // 读间隔超时
|
||||
|
TimeOuts.ReadTotalTimeoutMultiplier = 0; // 读时间系数
|
||||
|
TimeOuts.ReadTotalTimeoutConstant = 1; // 读时间常量
|
||||
|
SetCommTimeouts(serial_CommHandler, &TimeOuts); |
||||
|
|
||||
|
DWORD wCount = rxbufsize; // 成功读取的数据字节数
|
||||
|
BOOL bReadStat = ReadFile(serial_CommHandler, // 串口句柄
|
||||
|
rxbuf, // 数据首地址
|
||||
|
wCount, // 要读取的数据最大字节数
|
||||
|
&wCount, // DWORD*,用来接收返回成功读取的数据字节数
|
||||
|
NULL); |
||||
|
return wCount; |
||||
|
} |
||||
|
|
||||
|
bool serial_send(const uint8_t* data, size_t len) { |
||||
|
DWORD dwBytesWrite = len; |
||||
|
BOOL bWriteStat = WriteFile(serial_CommHandler, // 串口句柄
|
||||
|
(char*)data, // 数据首地址
|
||||
|
dwBytesWrite, // 要发送的数据字节数
|
||||
|
&dwBytesWrite, // DWORD*，用来接收返回成功发送的数据字节数
|
||||
|
NULL); // NULL为同步发送，OVERLAPPED*为异步发送
|
||||
|
return dwBytesWrite; |
||||
|
} |
||||
|
|
||||
|
bool serial_open(string serial, string baudrate) { |
||||
|
char portnamebuf[256] = {0}; |
||||
|
sprintf(portnamebuf, "\\\\.\\%s", serial.c_str()); |
||||
|
serial_CommHandler = CreateFileA(portnamebuf, // port name
|
||||
|
GENERIC_READ | GENERIC_WRITE, // Read/Write
|
||||
|
0, // No Sharing
|
||||
|
NULL, // No Security
|
||||
|
OPEN_EXISTING, // Open existing port only
|
||||
|
0, // Non Overlapped I/O
|
||||
|
NULL); // Null for Comm Devices
|
||||
|
if (serial_CommHandler == INVALID_HANDLE_VALUE) { |
||||
|
LOG("Error in opening serial port"); |
||||
|
return false; |
||||
|
} |
||||
|
DCB p; |
||||
|
memset(&p, 0, sizeof(p)); |
||||
|
p.DCBlength = sizeof(p); |
||||
|
p.BaudRate = atoi(baudrate.c_str()); // 波特率
|
||||
|
p.ByteSize = 8; |
||||
|
|
||||
|
// 设置校验位
|
||||
|
p.Parity = NOPARITY; |
||||
|
p.StopBits = ONESTOPBIT; |
||||
|
|
||||
|
if (!SetCommState(serial_CommHandler, &p)) { |
||||
|
CloseHandle(serial_CommHandler); |
||||
|
LOG("Error in setting serial port state"); |
||||
|
return false; |
||||
|
} |
||||
|
|
||||
|
serial_listen_thread.reset(new thread([]() { |
||||
|
while (true) { |
||||
|
uint8_t rx[1024] = {0}; |
||||
|
int rx_cnt = serial_receive(rx, 1024); |
||||
|
// LOG("接收到串口数据: %d", rx_cnt);
|
||||
|
if (rx_cnt != 0) { |
||||
|
lock_guard<mutex> lock(rx_lock_); |
||||
|
// LOG("接收到串口数据: %s", hextostr((char*)rx, rx_cnt).c_str());
|
||||
|
if (rx_cnt + serial_rxlen > sizeof(serial_rxcache)) { |
||||
|
memset(serial_rxcache, 0, sizeof(serial_rxcache)); |
||||
|
serial_rxlen = 0; |
||||
|
} |
||||
|
memcpy(serial_rxcache + serial_rxlen, rx, rx_cnt); |
||||
|
serial_rxlen += rx_cnt; |
||||
|
serial_last_rx_data_ticket = GetTickCount(); |
||||
|
} |
||||
|
this_thread::sleep_for(chrono::microseconds(1)); |
||||
|
} |
||||
|
return 0; |
||||
|
})); |
||||
|
|
||||
|
serial_parse_thread.reset(new thread([]() { |
||||
|
while (true) { |
||||
|
this_thread::sleep_for(chrono::milliseconds(1)); |
||||
|
|
||||
|
{ |
||||
|
lock_guard<mutex> lock(rx_lock_); |
||||
|
if (serial_rxlen == 0) continue; |
||||
|
|
||||
|
if (GetTickCount() - serial_last_rx_data_ticket > RX_OVERTIME_MS) { |
||||
|
serial_on_data((const char*)serial_rxcache, serial_rxlen); |
||||
|
memset(serial_rxcache, 0, sizeof(serial_rxcache)); |
||||
|
serial_rxlen = 0; |
||||
|
} |
||||
|
} |
||||
|
} |
||||
|
return 0; |
||||
|
})); |
||||
|
return true; |
||||
|
} |
||||
|
|
||||
|
typedef struct { |
||||
|
vector<uint8_t> data; |
||||
|
} data_t; |
||||
|
|
||||
|
list<data_t> data_list; |
||||
|
|
||||
|
#pragma pack(1)
|
||||
|
typedef struct { |
||||
|
uint8_t slaveAdd; |
||||
|
uint8_t modbusCmd; |
||||
|
uint8_t regAdd_H; |
||||
|
uint8_t regAdd_L; |
||||
|
uint8_t nregH; |
||||
|
uint8_t nregL; |
||||
|
uint8_t nbyte; |
||||
|
uint8_t data[]; |
||||
|
} modbus_data_t; |
||||
|
|
||||
|
typedef struct { |
||||
|
uint8_t slaveAdd; |
||||
|
uint8_t modbusCmd; |
||||
|
uint8_t regAdd_H; |
||||
|
uint8_t regAdd_L; |
||||
|
uint8_t nregH; |
||||
|
uint8_t nregL; |
||||
|
uint8_t check[2]; |
||||
|
} modbus_receipt_data_t; |
||||
|
|
||||
|
#pragma pack()
|
||||
|
|
||||
|
typedef struct { |
||||
|
uint8_t slaveAdd; |
||||
|
uint8_t modbusCmd; |
||||
|
uint16_t regAdd; |
||||
|
uint16_t nreg; |
||||
|
uint8_t nbyte; |
||||
|
uint16_t t1[5]; |
||||
|
|
||||
|
bool hasReceipt; |
||||
|
} temperature_data_t; |
||||
|
|
||||
|
bool parse_temperature_data(const char* rx, size_t len, temperature_data_t* temperaturedata) { |
||||
|
modbus_data_t* mdbusdata = (modbus_data_t*)rx; |
||||
|
if (mdbusdata->nbyte != 10) { |
||||
|
return false; |
||||
|
} |
||||
|
|
||||
|
int cmdlen = mdbusdata->nbyte + 7 + 2; |
||||
|
int receiptlen = 8; |
||||
|
|
||||
|
bool check = modbus_checkcrc16((uint8_t*)mdbusdata, cmdlen); |
||||
|
if (!check) { |
||||
|
return false; |
||||
|
} |
||||
|
|
||||
|
temperaturedata->slaveAdd = mdbusdata->slaveAdd; |
||||
|
temperaturedata->modbusCmd = mdbusdata->modbusCmd; |
||||
|
temperaturedata->regAdd = (mdbusdata->regAdd_H << 8) | mdbusdata->regAdd_L; |
||||
|
temperaturedata->nreg = (mdbusdata->nregH << 8) | mdbusdata->nregL; |
||||
|
temperaturedata->nbyte = mdbusdata->nbyte; |
||||
|
for (int i = 0; i < 5; i++) { |
||||
|
temperaturedata->t1[i] = (mdbusdata->data[i * 2] << 8) | mdbusdata->data[i * 2 + 1]; |
||||
|
} |
||||
|
|
||||
|
if (len == cmdlen + receiptlen) { |
||||
|
temperaturedata->hasReceipt = true; |
||||
|
}else{ |
||||
|
temperaturedata->hasReceipt = false; |
||||
|
} |
||||
|
return true; |
||||
|
} |
||||
|
|
||||
|
float I2T(int32_t I) { |
||||
|
int32_t temperature001 = (I / 1000.0 - 4) / (20 - 4) * 350 * 100.0; // 0.01度
|
||||
|
if (temperature001 < 0) { |
||||
|
temperature001 = 0; |
||||
|
} |
||||
|
return temperature001 / 100.0; |
||||
|
} |
||||
|
|
||||
|
static void serial_on_data(const char* data, size_t len) { //
|
||||
|
// LOG("接收到串口数据: %s", hextostr(data, len).c_str());
|
||||
|
|
||||
|
temperature_data_t td; |
||||
|
bool suc = parse_temperature_data(data, len, &td); |
||||
|
if (!suc) { |
||||
|
LOGD("解析失败 %s", hextostr(data, len).c_str()); |
||||
|
} else { |
||||
|
LOGD("TO:%d CMD[0x%x] [%x: nreg:%d nbyte:%d] Receipt[%s] || %.2f %.2f %.2f %.2f %.2f ||", td.slaveAdd, td.modbusCmd, td.regAdd, td.nreg, td.nbyte, //
|
||||
|
td.hasReceipt ? "YES" : "NO", I2T(td.t1[0]), I2T(td.t1[1]), I2T(td.t1[2]), I2T(td.t1[3]), I2T(td.t1[4])); |
||||
|
} |
||||
|
|
||||
|
// data_list.push_back({vector<uint8_t>(data, data + len)});
|
||||
|
} |
||||
|
|
||||
|
int _main(int argc, char const* argv[]) { |
||||
|
bool loginit = log_file_init(); |
||||
|
if (!loginit) { |
||||
|
LOGD("日志文件初始化失败"); |
||||
|
return -1; |
||||
|
} |
||||
|
|
||||
|
// WSADATA wsaData;
|
||||
|
// WSAStartup(MAKEWORD(2, 2), &wsaData);
|
||||
|
LOGD("黄金温度消息解析程序 v2.0"); |
||||
|
|
||||
|
// 请输串口号
|
||||
|
string serial; |
||||
|
cout << "请输入串口号："; |
||||
|
cin >> serial; |
||||
|
|
||||
|
// 请输波特率
|
||||
|
string baudrate; |
||||
|
cout << "请输入波特率："; |
||||
|
cin >> baudrate; |
||||
|
|
||||
|
bool suc = serial_open(serial, baudrate); |
||||
|
if (!suc) { |
||||
|
cout << "串口打开失败" << endl; |
||||
|
return -1; |
||||
|
} |
||||
|
|
||||
|
LOGD("串口打开成功: %s(%d)", serial.c_str(), atoi(baudrate.c_str())); |
||||
|
LOGD("开始监听数据"); |
||||
|
while (true) { |
||||
|
Sleep(1000); |
||||
|
} |
||||
|
return 0; |
||||
|
} |
||||
|
|
||||
|
int main(int argc, char const* argv[]) { |
||||
|
_main(argc, argv); |
||||
|
while (true) { |
||||
|
Sleep(1000); |
||||
|
} |
||||
|
} |
||||
Write
Preview
Loading…
Cancel
Save
Reference in new issue