init
This commit is contained in:
Chenwenxuan
831
device/SerialPort/modbustcp.cpp
Normal file
831
device/SerialPort/modbustcp.cpp
Normal file
@@ -0,0 +1,831 @@
|
||||
#include "modbustcp.h"
|
||||
|
||||
#include "deviceproxy.h"
|
||||
|
||||
|
||||
ModbusTCP* ModbusTCP::uniqueInstance = nullptr;
|
||||
ModbusTCP* ModbusTCP::instance()
|
||||
{
|
||||
if (!uniqueInstance) {
|
||||
uniqueInstance = new ModbusTCP();
|
||||
}
|
||||
return uniqueInstance;
|
||||
}
|
||||
ModbusTCP::ModbusTCP()
|
||||
{
|
||||
sockfd = INVALID_SOCKET;
|
||||
sockfd_fl = INVALID_SOCKET;
|
||||
sockfd_record = INVALID_SOCKET;
|
||||
port = 502;
|
||||
ipAddr = "";
|
||||
ipAddr_fl = "";
|
||||
ipAddr_record = "";
|
||||
ipAddr_electric_resistance = "";
|
||||
_seq_modbus = 0;
|
||||
_seq_modbus_fl = 0;
|
||||
stopFlag = false;
|
||||
memset(RFID,0,50);
|
||||
PLCSts[0] = -1;
|
||||
PLCSts[1] = -1;
|
||||
TransferPLCCmd.cmdAddr = 0;
|
||||
TransferPLCCmd.cmdDelay = 0;
|
||||
TransferPLCCmd.cmdWriteFlag = false;
|
||||
SeparatePLCCmd.cmdAddr = 0;
|
||||
SeparatePLCCmd.cmdDelay = 0;
|
||||
SeparatePLCCmd.cmdWriteFlag = false;
|
||||
WORD sockVersion = MAKEWORD(2, 2);
|
||||
WSADATA data;
|
||||
WSAStartup(sockVersion, &data);
|
||||
|
||||
InitializeCriticalSection(&mCsRead);
|
||||
InitializeCriticalSection(&mCsRead_fl);
|
||||
}
|
||||
|
||||
ModbusTCP::~ModbusTCP(void)
|
||||
{
|
||||
if (sockfd != INVALID_SOCKET)
|
||||
{
|
||||
CloseConn();
|
||||
}
|
||||
if (sockfd_fl != INVALID_SOCKET)
|
||||
{
|
||||
CloseConn_fl();
|
||||
}
|
||||
if (sockfd_record != INVALID_SOCKET)
|
||||
{
|
||||
CloseConn_record();
|
||||
}
|
||||
|
||||
sockfd = INVALID_SOCKET;
|
||||
sockfd_fl = INVALID_SOCKET;
|
||||
sockfd_record = INVALID_SOCKET;
|
||||
WSACleanup();
|
||||
}
|
||||
|
||||
bool ModbusTCP::ConnPLC()
|
||||
{
|
||||
struct sockaddr_in server_addr;
|
||||
char* ip;
|
||||
QByteArray ba = ipAddr.toLatin1(); // must
|
||||
ip=ba.data();
|
||||
|
||||
|
||||
|
||||
sockfd = socket(AF_INET, SOCK_STREAM, 0);
|
||||
if (sockfd == INVALID_SOCKET) {
|
||||
//printf("Failed to create socket: %s\n", strerror(errno));
|
||||
return false;
|
||||
}
|
||||
server_addr.sin_family = AF_INET;
|
||||
server_addr.sin_port = htons(port);
|
||||
//inet_pton(AF_INET, "server_ip", &server_addr.sin_addr.s_addr);
|
||||
server_addr.sin_addr.s_addr = inet_addr(ip);
|
||||
if (connect(sockfd, (struct sockaddr *)&server_addr, sizeof(server_addr)) == -1) {
|
||||
//printf("Failed to connect to server: %s\n", strerror(errno));
|
||||
closesocket(sockfd);
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
bool ModbusTCP::ConnPLC_fl()
|
||||
{
|
||||
struct sockaddr_in server_addr;
|
||||
char* ip;
|
||||
QByteArray ba = ipAddr_fl.toLatin1(); // must
|
||||
ip=ba.data();
|
||||
|
||||
|
||||
sockfd_fl = socket(AF_INET, SOCK_STREAM, 0);
|
||||
if (sockfd_fl == INVALID_SOCKET) {
|
||||
//printf("Failed to create socket: %s\n", strerror(errno));
|
||||
return false;
|
||||
}
|
||||
server_addr.sin_family = AF_INET;
|
||||
server_addr.sin_port = htons(port);
|
||||
//inet_pton(AF_INET, "server_ip", &server_addr.sin_addr.s_addr);
|
||||
server_addr.sin_addr.s_addr = inet_addr(ip);
|
||||
if (connect(sockfd_fl, (struct sockaddr *)&server_addr, sizeof(server_addr)) == -1) {
|
||||
//printf("Failed to connect to server: %s\n", strerror(errno));
|
||||
closesocket(sockfd_fl);
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
bool ModbusTCP::ConnPLC_force()
|
||||
{
|
||||
struct sockaddr_in server_addr;
|
||||
char* ip;
|
||||
QByteArray ba = ipAddr_record.toLatin1(); // must
|
||||
ip=ba.data();
|
||||
|
||||
sockfd_record = socket(AF_INET, SOCK_STREAM, 0);
|
||||
if (sockfd_record == INVALID_SOCKET) {
|
||||
//printf("Failed to create socket: %s\n", strerror(errno));
|
||||
return false;
|
||||
}
|
||||
server_addr.sin_family = AF_INET;
|
||||
server_addr.sin_port = htons(6000);
|
||||
//inet_pton(AF_INET, "server_ip", &server_addr.sin_addr.s_addr);
|
||||
server_addr.sin_addr.s_addr = inet_addr(ip);
|
||||
if (connect(sockfd_record, (struct sockaddr *)&server_addr, sizeof(server_addr)) == -1) {
|
||||
//printf("Failed to connect to server: %s\n", strerror(errno));
|
||||
closesocket(sockfd_record);
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
bool ModbusTCP::ConnPLC_electric_resistance()
|
||||
{
|
||||
struct sockaddr_in server_addr;
|
||||
char* ip;
|
||||
//ipAddr_electric_resistance = "192.168.30.6";
|
||||
QByteArray ba = ipAddr_electric_resistance.toLatin1(); // must AF_LOCAL
|
||||
ip=ba.data();
|
||||
|
||||
sockfd_electric_resistance = socket(AF_INET, SOCK_STREAM, 0);
|
||||
if (sockfd_electric_resistance == INVALID_SOCKET) {
|
||||
//printf("Failed to create socket: %s\n", strerror(errno));
|
||||
return false;
|
||||
}
|
||||
server_addr.sin_family = AF_INET;
|
||||
server_addr.sin_port = htons(6677);
|
||||
//inet_pton(AF_INET, "server_ip", &server_addr.sin_addr.s_addr);
|
||||
server_addr.sin_addr.s_addr = inet_addr(ip);
|
||||
if (connect(sockfd_electric_resistance, (struct sockaddr *)&server_addr, sizeof(server_addr)) == -1) {
|
||||
//printf("Failed to connect to server: %s\n", strerror(errno));
|
||||
closesocket(sockfd_electric_resistance);
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
bool ModbusTCP::CloseConn()
|
||||
{
|
||||
bool ret = true;
|
||||
if (sockfd != INVALID_SOCKET)
|
||||
closesocket(sockfd);
|
||||
sockfd = INVALID_SOCKET;
|
||||
|
||||
|
||||
return ret;
|
||||
}
|
||||
bool ModbusTCP::CloseConn_fl()
|
||||
{
|
||||
bool ret = true;
|
||||
if (sockfd_fl != INVALID_SOCKET)
|
||||
closesocket(sockfd_fl);
|
||||
sockfd_fl = INVALID_SOCKET;
|
||||
|
||||
return ret;
|
||||
}
|
||||
bool ModbusTCP::CloseConn_record()
|
||||
{
|
||||
bool ret = true;
|
||||
if (sockfd_record != INVALID_SOCKET)
|
||||
closesocket(sockfd_record);
|
||||
sockfd_record = INVALID_SOCKET;
|
||||
|
||||
return ret;
|
||||
}
|
||||
bool ModbusTCP::CloseConn_electric_resistance()
|
||||
{
|
||||
bool ret = true;
|
||||
if (sockfd_electric_resistance != INVALID_SOCKET)
|
||||
closesocket(sockfd_electric_resistance);
|
||||
sockfd_electric_resistance = INVALID_SOCKET;
|
||||
|
||||
return ret;
|
||||
}
|
||||
int ModbusTCP::SendCmdRead(unsigned int sockfd,char *data, unsigned short data_len)
|
||||
{
|
||||
//可能存在问题。
|
||||
//1、接收按照数据长度接收，然后校验接收长度是否正确
|
||||
//2、返回的数据，是否正确，是否要进行判断？
|
||||
char rev_buf[4096];
|
||||
int RevDataLen = 0;
|
||||
|
||||
//发送modbus请求
|
||||
if (send(sockfd, data, data_len, 0) == -1) {
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
|
||||
}
|
||||
//printf("Sent request successfully.\n");
|
||||
//接收modbus请求
|
||||
RevDataLen = recv(sockfd, rev_buf, 4096, 0);
|
||||
if (RevDataLen == -1) {
|
||||
//printf("Failed to receive response: %s\n", strerror(errno));
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
}
|
||||
int ret = DataDecode(rev_buf, RevDataLen);
|
||||
return ret;
|
||||
}
|
||||
int ModbusTCP::SendCmdWrite(unsigned int sockfd,char *data, unsigned short data_len)
|
||||
{
|
||||
//可能存在问题。
|
||||
//1、接收按照数据长度接收，然后校验接收长度是否正确
|
||||
//2、返回的数据，是否正确，是否要进行判断？
|
||||
|
||||
char rev_buf[4096];
|
||||
int RevDataLen = 0;
|
||||
|
||||
//发送modbus请求
|
||||
if (send(sockfd, data, data_len, 0) == -1) {
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
}
|
||||
//printf("Sent request successfully.\n");
|
||||
//接收modbus请求
|
||||
RevDataLen = recv(sockfd, rev_buf, 4096, 0);
|
||||
if (RevDataLen == -1) {
|
||||
//printf("Failed to receive response: %s\n", strerror(errno));
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
}
|
||||
//int ret = Com_decode(rev_buf, RevDataLen);
|
||||
return 0;
|
||||
}
|
||||
int ModbusTCP::SendCmdRead_fl(unsigned int sockfd,char *data, unsigned short data_len)
|
||||
{
|
||||
//可能存在问题。
|
||||
//1、接收按照数据长度接收，然后校验接收长度是否正确
|
||||
//2、返回的数据，是否正确，是否要进行判断？
|
||||
char rev_buf[4096];
|
||||
int RevDataLen = 0;
|
||||
|
||||
//发送modbus请求
|
||||
if (send(sockfd, data, data_len, 0) == -1) {
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
|
||||
}
|
||||
//printf("Sent request successfully.\n");
|
||||
//接收modbus请求
|
||||
RevDataLen = recv(sockfd, rev_buf, 4096, 0);
|
||||
if (RevDataLen == -1) {
|
||||
//printf("Failed to receive response: %s\n", strerror(errno));
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
}
|
||||
int ret = DataDecode(rev_buf, RevDataLen);
|
||||
return ret;
|
||||
}
|
||||
int ModbusTCP::SendCmdWrite_fl(unsigned int sockfd,char *data, unsigned short data_len)
|
||||
{
|
||||
//可能存在问题。
|
||||
//1、接收按照数据长度接收，然后校验接收长度是否正确
|
||||
//2、返回的数据，是否正确，是否要进行判断？
|
||||
|
||||
char rev_buf[4096];
|
||||
int RevDataLen = 0;
|
||||
|
||||
//发送modbus请求
|
||||
if (send(sockfd, data, data_len, 0) == -1) {
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
}
|
||||
//printf("Sent request successfully.\n");
|
||||
//接收modbus请求
|
||||
RevDataLen = recv(sockfd, rev_buf, 4096, 0);
|
||||
if (RevDataLen == -1) {
|
||||
//printf("Failed to receive response: %s\n", strerror(errno));
|
||||
closesocket(sockfd);
|
||||
return -1;
|
||||
}
|
||||
//int ret = Com_decode(rev_buf, RevDataLen);
|
||||
return 0;
|
||||
}
|
||||
int ModbusTCP::DataDecode(char *data, int len)
|
||||
{
|
||||
if ((len >= 10) && (len <= 11))
|
||||
{
|
||||
return data[len-1];
|
||||
}
|
||||
else if (len > 11)
|
||||
{
|
||||
memset(MODBUSTCP->RFID,0,50);
|
||||
memcpy(RFID,&data[9],len-9);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ModbusTCP::ModbusWrite(unsigned char cmd,unsigned short addr, unsigned short data)
|
||||
{
|
||||
int ret;
|
||||
|
||||
|
||||
unsigned char sendBuf[50];//发送缓存
|
||||
unsigned short temps = _seq_modbus++;//类似于TCP的seq序列号，让其自增即可
|
||||
unsigned char* temp = reinterpret_cast<unsigned char*>(&temps);
|
||||
//协议头
|
||||
sendBuf[0] = *(temp + 1);//前两位为事务处理标识，2个字节的序列号
|
||||
sendBuf[1] = *(temp);
|
||||
|
||||
sendBuf[2] = 0;//协议标识，两个字节，0000即为Modbus TCP协议
|
||||
sendBuf[3] = 0;
|
||||
|
||||
sendBuf[4] = 0;//长度字段（前半部分字节）
|
||||
sendBuf[5] = 6;//随后字节数
|
||||
|
||||
sendBuf[6] = 1;//单元标志，定义连接目的节点的其他设备（这个设备是1号，所以是0x01）
|
||||
//以上是Modbus协议头部分
|
||||
//协议体
|
||||
sendBuf[7] = cmd;//Modbus功能码 ，这里是 写多个保持寄存器 操作
|
||||
temps = addr;
|
||||
sendBuf[8] = *(temp + 1); //写寄存器起始地址高字节
|
||||
sendBuf[9] = *(temp); //写寄存器起始地址低字节（所以这里是往0x0100地址写寄存器）
|
||||
|
||||
//sendBuf[10] = 0x00; //写寄存器数量高字节
|
||||
//sendBuf[11] = 0x01; //写寄存器数量低字节
|
||||
|
||||
//sendBuf[12] = 0x01; //数据长度
|
||||
|
||||
//写1个值到报文中
|
||||
temps = data;
|
||||
//sendBuf[10] = data;
|
||||
sendBuf[10] = *(temp + 1);
|
||||
sendBuf[11] = *(temp);
|
||||
|
||||
|
||||
bool ret_conn = true;
|
||||
::EnterCriticalSection(&mCsRead);
|
||||
ret_conn = ConnPLC();
|
||||
if (ret_conn)
|
||||
ret = SendCmdWrite(sockfd,reinterpret_cast<char*>(sendBuf), 12);
|
||||
else
|
||||
{
|
||||
CloseConn();
|
||||
::LeaveCriticalSection(&mCsRead);
|
||||
return -1;
|
||||
}
|
||||
CloseConn();
|
||||
::LeaveCriticalSection(&mCsRead);
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
int ModbusTCP::ModbusWrite_fl(unsigned char cmd,unsigned short addr, unsigned short data)
|
||||
{
|
||||
int ret;
|
||||
|
||||
|
||||
unsigned char sendBuf[50];//发送缓存
|
||||
unsigned short temps = _seq_modbus_fl++;//类似于TCP的seq序列号，让其自增即可
|
||||
unsigned char* temp = reinterpret_cast<unsigned char*>(&temps);
|
||||
//协议头
|
||||
sendBuf[0] = *(temp + 1);//前两位为事务处理标识，2个字节的序列号
|
||||
sendBuf[1] = *(temp);
|
||||
|
||||
sendBuf[2] = 0;//协议标识，两个字节，0000即为Modbus TCP协议
|
||||
sendBuf[3] = 0;
|
||||
|
||||
sendBuf[4] = 0;//长度字段（前半部分字节）
|
||||
sendBuf[5] = 6;//随后字节数
|
||||
|
||||
sendBuf[6] = 1;//单元标志，定义连接目的节点的其他设备（这个设备是1号，所以是0x01）
|
||||
//以上是Modbus协议头部分
|
||||
//协议体
|
||||
sendBuf[7] = cmd;//Modbus功能码 ，这里是 写多个保持寄存器 操作
|
||||
temps = addr;
|
||||
sendBuf[8] = *(temp + 1); //写寄存器起始地址高字节
|
||||
sendBuf[9] = *(temp); //写寄存器起始地址低字节（所以这里是往0x0100地址写寄存器）
|
||||
|
||||
//sendBuf[10] = 0x00; //写寄存器数量高字节
|
||||
//sendBuf[11] = 0x01; //写寄存器数量低字节
|
||||
|
||||
//sendBuf[12] = 0x01; //数据长度
|
||||
|
||||
//写1个值到报文中
|
||||
temps = data;
|
||||
//sendBuf[10] = data;
|
||||
sendBuf[10] = *(temp + 1);
|
||||
sendBuf[11] = *(temp);
|
||||
|
||||
|
||||
bool ret_conn = true;
|
||||
::EnterCriticalSection(&mCsRead_fl);
|
||||
ret_conn = ConnPLC_fl();
|
||||
if (ret_conn)
|
||||
ret = SendCmdWrite_fl(sockfd_fl,reinterpret_cast<char*>(sendBuf), 12);
|
||||
else
|
||||
{
|
||||
CloseConn_fl();
|
||||
::LeaveCriticalSection(&mCsRead_fl);
|
||||
return -1;
|
||||
}
|
||||
CloseConn_fl();
|
||||
::LeaveCriticalSection(&mCsRead_fl);
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
int ModbusTCP::ModbusWrite_force(char * data, int len)
|
||||
{
|
||||
|
||||
bool ret_conn = true;
|
||||
//::EnterCriticalSection(&mCsRead_fl);
|
||||
ret_conn = ConnPLC_force();
|
||||
if (ret_conn)
|
||||
{
|
||||
if (send(sockfd_record, data, len, 0) == -1)
|
||||
{
|
||||
CloseConn_record();
|
||||
qDebug()<< "result1: "<<data;
|
||||
//::LeaveCriticalSection(&mCsRead_fl);
|
||||
return -1;
|
||||
}
|
||||
else
|
||||
{
|
||||
qDebug()<< "result: "<<data;
|
||||
CloseConn_record();
|
||||
//::LeaveCriticalSection(&mCsRead_fl);
|
||||
return 0;
|
||||
}
|
||||
|
||||
}
|
||||
else
|
||||
{
|
||||
CloseConn_record();
|
||||
qDebug()<< "result2: "<<data;
|
||||
//::LeaveCriticalSection(&mCsRead_fl);
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
int ModbusTCP::ModbusWrite_electric_resistance(char * data, int len, char * rev_buf)
|
||||
{
|
||||
|
||||
int RevDataLen = 0;
|
||||
bool ret_conn = true;
|
||||
|
||||
// if (data[0] == 'G')
|
||||
// {
|
||||
// memset(array_pos,0,sizeof(array_pos));
|
||||
// }
|
||||
|
||||
// ret_conn = ConnPLC_electric_resistance();
|
||||
// if (ret_conn)
|
||||
{
|
||||
if (send(sockfd_electric_resistance, data, len, 0) == -1)
|
||||
{
|
||||
CloseConn_electric_resistance();
|
||||
return -1;
|
||||
}
|
||||
else
|
||||
{
|
||||
if(strcmp(data,"***") == 0)
|
||||
return 0;
|
||||
RevDataLen = recv(sockfd_electric_resistance, rev_buf, 4096, 0);
|
||||
if (RevDataLen == -1) {
|
||||
closesocket(sockfd_electric_resistance);
|
||||
return -1;
|
||||
}
|
||||
return RevDataLen;
|
||||
}
|
||||
|
||||
}
|
||||
// else
|
||||
// {
|
||||
// CloseConn_electric_resistance();
|
||||
// qDebug()<< "result2: "<<data;
|
||||
// //::LeaveCriticalSection(&mCsRead_fl);
|
||||
// return -1;
|
||||
// }
|
||||
|
||||
}
|
||||
|
||||
|
||||
int ModbusTCP::ModbusRead(unsigned short addr,int dataLen)
|
||||
{
|
||||
|
||||
int ret;
|
||||
|
||||
|
||||
unsigned char sendBuf[50];//发送缓存
|
||||
unsigned short temps = _seq_modbus++;//类似于TCP的seq序列号，让其自增即可
|
||||
unsigned char* temp = reinterpret_cast<unsigned char*>(&temps);
|
||||
//协议头
|
||||
sendBuf[0] = *(temp + 1);//前两位为事务处理标识，2个字节的序列号
|
||||
sendBuf[1] = *(temp);
|
||||
|
||||
sendBuf[2] = 0;//协议标识，两个字节，0000即为Modbus TCP协议
|
||||
sendBuf[3] = 0;
|
||||
|
||||
sendBuf[4] = 0;//长度字段（前半部分字节）
|
||||
sendBuf[5] = 6;//随后字节数
|
||||
|
||||
sendBuf[6] = 0x01;//单元标志，定义连接目的节点的其他设备（这个设备是1号，所以是0x01）
|
||||
//以上是Modbus协议头部分
|
||||
//协议体
|
||||
sendBuf[7] = 0x03;//Modbus功能码 ，这里是读
|
||||
temps = addr;
|
||||
sendBuf[8] = *(temp + 1); //写寄存器起始地址高字节
|
||||
sendBuf[9] = *(temp); //写寄存器起始地址低字节（所以这里是往0x0100地址写寄存器）
|
||||
sendBuf[10] = 0x00; //长度
|
||||
sendBuf[11] = dataLen; //写寄存器数量低字节
|
||||
|
||||
bool ret_conn = true;
|
||||
::EnterCriticalSection(&mCsRead);
|
||||
ret_conn = ConnPLC();
|
||||
if (ret_conn)
|
||||
ret = SendCmdRead(sockfd,reinterpret_cast<char*>(sendBuf), 12);
|
||||
else
|
||||
{
|
||||
CloseConn();
|
||||
::LeaveCriticalSection(&mCsRead);
|
||||
return -1;
|
||||
}
|
||||
CloseConn();
|
||||
::LeaveCriticalSection(&mCsRead);
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
int ModbusTCP::ModbusRead_fl(unsigned short addr,int dataLen)
|
||||
{
|
||||
|
||||
int ret;
|
||||
|
||||
|
||||
unsigned char sendBuf[50];//发送缓存
|
||||
unsigned short temps = _seq_modbus_fl++;//类似于TCP的seq序列号，让其自增即可
|
||||
unsigned char* temp = reinterpret_cast<unsigned char*>(&temps);
|
||||
//协议头
|
||||
sendBuf[0] = *(temp + 1);//前两位为事务处理标识，2个字节的序列号
|
||||
sendBuf[1] = *(temp);
|
||||
|
||||
sendBuf[2] = 0;//协议标识，两个字节，0000即为Modbus TCP协议
|
||||
sendBuf[3] = 0;
|
||||
|
||||
sendBuf[4] = 0;//长度字段（前半部分字节）
|
||||
sendBuf[5] = 6;//随后字节数
|
||||
|
||||
sendBuf[6] = 0x01;//单元标志，定义连接目的节点的其他设备（这个设备是1号，所以是0x01）
|
||||
//以上是Modbus协议头部分
|
||||
//协议体
|
||||
sendBuf[7] = 0x03;//Modbus功能码 ，这里是读
|
||||
temps = addr;
|
||||
sendBuf[8] = *(temp + 1); //写寄存器起始地址高字节
|
||||
sendBuf[9] = *(temp); //写寄存器起始地址低字节（所以这里是往0x0100地址写寄存器）
|
||||
sendBuf[10] = 0x00; //长度
|
||||
sendBuf[11] = dataLen; //写寄存器数量低字节
|
||||
|
||||
bool ret_conn = true;
|
||||
::EnterCriticalSection(&mCsRead_fl);
|
||||
ret_conn = ConnPLC_fl();
|
||||
if (ret_conn)
|
||||
ret = SendCmdRead_fl(sockfd_fl,reinterpret_cast<char*>(sendBuf), 12);
|
||||
else
|
||||
{
|
||||
CloseConn_fl();
|
||||
::LeaveCriticalSection(&mCsRead_fl);
|
||||
return -1;
|
||||
}
|
||||
CloseConn_fl();
|
||||
::LeaveCriticalSection(&mCsRead_fl);
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
int ModbusTCP::TransferPLCRun(unsigned short addr,int delay)
|
||||
{
|
||||
if ((addr == 0) || (delay <= 0))
|
||||
return -1;
|
||||
if (TransferPLCCmd.cmdAddr != 0)
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
else
|
||||
{
|
||||
TransferPLCCmd.cmdAddr = addr;
|
||||
TransferPLCCmd.cmdDelay = delay;
|
||||
TransferPLCCmd.cmdWriteFlag = false;
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
int ModbusTCP::SeparatePLCRun(unsigned short addr,int delay)
|
||||
{
|
||||
if ((addr == 0) || (delay <= 0))
|
||||
return -1;
|
||||
if (SeparatePLCCmd.cmdAddr != 0)
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
else
|
||||
{
|
||||
SeparatePLCCmd.cmdAddr = addr;
|
||||
SeparatePLCCmd.cmdDelay = delay;
|
||||
SeparatePLCCmd.cmdWriteFlag = false;
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
int ModbusTCP::getModbusPara(QString DevName)
|
||||
{
|
||||
QSettings *settings;//申明一个QSetting类函数
|
||||
settings = new QSettings ("SerialDevSet.ini", QSettings::IniFormat);//构建函数
|
||||
|
||||
QString strKey;
|
||||
strKey = "/"+DevName+"/ipAddr";
|
||||
ipAddr = settings->value(strKey).toString();
|
||||
strKey = "/"+DevName+"/ipAddr_fl";
|
||||
ipAddr_fl = settings->value(strKey).toString();
|
||||
|
||||
strKey = "/"+DevName+"/ipAddr_record";
|
||||
ipAddr_record = settings->value(strKey).toString();
|
||||
|
||||
strKey = "/"+DevName+"/ipAddr_electric_resistance";
|
||||
ipAddr_electric_resistance = settings->value(strKey).toString();
|
||||
|
||||
strKey = "/"+DevName+"/shangReadAddr";
|
||||
shangReadAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/shangWriteAddr";
|
||||
shangWriteAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/shangReadRFIDAddr";
|
||||
shangReadRFIDAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/shangReadVacuumAddr";
|
||||
shangReadVacuumAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/shangWriteHeartbeatAddr";
|
||||
shangWriteHeartbeatAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/shangWriteVacuumAddr";
|
||||
shangWriteVacuumAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/xiaReadAddr";
|
||||
xiaReadAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/xiaWriteAddr";
|
||||
xiaWriteAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/xiaReadStsAddr";
|
||||
xiaReadStsAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/ReadTransferPLCStsAddr";
|
||||
ReadTransferPLCStsAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/xiaWriteVacuumAddr";
|
||||
xiaWriteVacuumAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
strKey = "/"+DevName+"/InitAddr";
|
||||
InitAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/RunAddr";
|
||||
RunAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/StopAddr";
|
||||
StopAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
strKey = "/"+DevName+"/ClearAlarmAddr";
|
||||
ClearAlarmAddr = static_cast<unsigned short>(settings->value(strKey).toInt());
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ModbusTCP::Heartbeat(void)
|
||||
{
|
||||
int internal_read = 0;
|
||||
int internal_write = 0;
|
||||
int internal_sts = 0;
|
||||
int ret_modbus;
|
||||
int count = 0;
|
||||
bool readFlag = false;
|
||||
int fail_count[2] = {0};
|
||||
int internal_TransferPLCCmd_sts = 0;
|
||||
while (1)
|
||||
{
|
||||
internal_read++;
|
||||
internal_write++;
|
||||
internal_sts++;
|
||||
if ((internal_read >= 240) && (readFlag))
|
||||
{
|
||||
ret_modbus = MODBUSTCP->ModbusRead(MODBUSTCP->shangWriteHeartbeatAddr, 1);
|
||||
if (ret_modbus != 0)
|
||||
{
|
||||
count++;
|
||||
}
|
||||
else
|
||||
{
|
||||
count = 0;
|
||||
MODBUSTCP->connFlag = true;
|
||||
}
|
||||
if (count >= 3)
|
||||
{
|
||||
MODBUSTCP->connFlag = false;
|
||||
}
|
||||
readFlag = false;
|
||||
internal_write = 0;
|
||||
}
|
||||
if ((internal_write >= 20) && (!readFlag))
|
||||
{
|
||||
ret_modbus = MODBUSTCP->ModbusWrite(0x06,MODBUSTCP->shangWriteHeartbeatAddr, 1);
|
||||
internal_read = 0;
|
||||
readFlag = true;
|
||||
}
|
||||
|
||||
if (internal_sts >= 20)
|
||||
{
|
||||
ret_modbus = MODBUSTCP->ModbusRead(MODBUSTCP->xiaReadStsAddr, 1);
|
||||
if (ret_modbus == -1)
|
||||
{
|
||||
fail_count[0]++;
|
||||
if (fail_count[0] >= 3)
|
||||
{
|
||||
PLCSts[0] = -1;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
fail_count[0] = 0;
|
||||
PLCSts[0] = ret_modbus;
|
||||
}
|
||||
ret_modbus = MODBUSTCP->ModbusRead(MODBUSTCP->ReadTransferPLCStsAddr, 1);
|
||||
TransferPLCSts = ret_modbus;
|
||||
emit DEV->TransferPLCSGL(PLCSts[0]);
|
||||
internal_sts = 0;
|
||||
|
||||
}
|
||||
|
||||
if (TransferPLCCmd.cmdAddr != 0)
|
||||
{
|
||||
if (TransferPLCCmd.cmdWriteFlag == false)
|
||||
{
|
||||
//发送写命令
|
||||
ret_modbus = MODBUSTCP->ModbusWrite(0x05,TransferPLCCmd.cmdAddr, 0xff00);
|
||||
TransferPLCCmd.cmdWriteFlag = true;
|
||||
}
|
||||
internal_TransferPLCCmd_sts++;
|
||||
if ((internal_TransferPLCCmd_sts * 5) >= TransferPLCCmd.cmdDelay)
|
||||
{
|
||||
//发送清除命令
|
||||
ret_modbus = MODBUSTCP->ModbusWrite(0x05,TransferPLCCmd.cmdAddr, 0);
|
||||
TransferPLCCmd.cmdWriteFlag = false;
|
||||
TransferPLCCmd.cmdAddr = 0;
|
||||
TransferPLCCmd.cmdDelay = 0;
|
||||
internal_TransferPLCCmd_sts = 0;
|
||||
}
|
||||
}
|
||||
|
||||
Sleep(5);
|
||||
}
|
||||
}
|
||||
|
||||
int ModbusTCP::Heartbeat_fl(void)
|
||||
{
|
||||
int internal_sts = 0;
|
||||
int ret_modbus;
|
||||
int fail_count[2] = {0};
|
||||
int internal_SeparatePLCCmd_sts = 0;
|
||||
while (1)
|
||||
{
|
||||
|
||||
internal_sts++;
|
||||
|
||||
if (internal_sts >= 20)
|
||||
{
|
||||
ret_modbus = MODBUSTCP->ModbusRead_fl(MODBUSTCP->xiaReadStsAddr, 1);
|
||||
if (ret_modbus == -1)
|
||||
{
|
||||
fail_count[1]++;
|
||||
if (fail_count[1] >= 3)
|
||||
{
|
||||
PLCSts[1] = -1;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
fail_count[1] = 0;
|
||||
PLCSts[1] = ret_modbus;
|
||||
}
|
||||
emit DEV->SeparatePLCSGL(PLCSts[1]);
|
||||
internal_sts = 0;
|
||||
|
||||
}
|
||||
|
||||
if (SeparatePLCCmd.cmdAddr != 0)
|
||||
{
|
||||
if (SeparatePLCCmd.cmdWriteFlag == false)
|
||||
{
|
||||
ret_modbus = MODBUSTCP->ModbusWrite_fl(0x05,SeparatePLCCmd.cmdAddr, 0xff00);
|
||||
SeparatePLCCmd.cmdWriteFlag = true;
|
||||
}
|
||||
internal_SeparatePLCCmd_sts++;
|
||||
if ((internal_SeparatePLCCmd_sts * 5) >= SeparatePLCCmd.cmdDelay)
|
||||
{
|
||||
//发送清除命令
|
||||
ret_modbus = MODBUSTCP->ModbusWrite_fl(0x05,SeparatePLCCmd.cmdAddr, 0);
|
||||
SeparatePLCCmd.cmdWriteFlag = false;
|
||||
SeparatePLCCmd.cmdAddr = 0;
|
||||
SeparatePLCCmd.cmdDelay = 0;
|
||||
internal_SeparatePLCCmd_sts = 0;
|
||||
}
|
||||
}
|
||||
|
||||
Sleep(5);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* 1、正常自动加工时，在工作线程跑上下料
|
||||
* 2、在测试界面，使用线程（CreateThread），有运行标记
|
||||
*/
|
||||
Reference in New Issue
Block a user