|
|
#include "TransformerExport.h"
|
|
|
|
|
|
|
|
|
|
|
|
TransformerExport::TransformerExport()
|
|
|
{
|
|
|
}
|
|
|
|
|
|
|
|
|
TransformerExport::~TransformerExport()
|
|
|
{
|
|
|
}
|
|
|
|
|
|
bool TransformerExport::InitDahuanTransformer()
|
|
|
{
|
|
|
//清除告警
|
|
|
std::vector<int> saparateCommVec = { m_leftTopComm , m_rightTopComm , m_leftButtomComm , m_rightButtomComm };
|
|
|
for (auto& iter : saparateCommVec)
|
|
|
{
|
|
|
m_transformer.SetWorkMode(FALSE, 100);
|
|
|
std::string strCom = std::to_string(m_nComBaduRate);
|
|
|
strCom += ",N,8,1";
|
|
|
bool bComOpen = m_transformer.Open(iter, (char*)strCom.c_str());
|
|
|
if (!bComOpen)
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
unsigned char Buf[21] = { 0 };
|
|
|
Buf[0] = 0x01;
|
|
|
Buf[1] = 0x10;
|
|
|
Buf[2] = 0x16;
|
|
|
Buf[3] = 0x00;
|
|
|
Buf[4] = 0x00;
|
|
|
Buf[5] = 0x06;
|
|
|
Buf[6] = 0x0C;
|
|
|
Buf[7] = 0x00;
|
|
|
Buf[8] = 0x00;
|
|
|
Buf[9] = 0x00;
|
|
|
Buf[10] = 0x00;
|
|
|
Buf[11] = 0x00;
|
|
|
Buf[12] = 0x00;
|
|
|
Buf[13] = 0x00;
|
|
|
Buf[14] = 0x00;
|
|
|
Buf[15] = 0x00;
|
|
|
Buf[16] = 0x00;
|
|
|
Buf[17] = 0x00;
|
|
|
Buf[18] = 0x30;
|
|
|
Buf[19] = 0xE4;
|
|
|
Buf[20] = 0xA7;
|
|
|
m_transformer.WriteBuf(Buf, 21);
|
|
|
}
|
|
|
//执行回原指令
|
|
|
for (auto& iter : saparateCommVec)
|
|
|
{
|
|
|
m_transformer.SetWorkMode(FALSE, 100);
|
|
|
std::string strCom = std::to_string(m_nComBaduRate);
|
|
|
strCom += ",N,8,1";
|
|
|
bool bComOpen = m_transformer.Open(iter, (char*)strCom.c_str());
|
|
|
unsigned char Buf[8] = { 0 };
|
|
|
Buf[0] = 0x01;
|
|
|
Buf[1] = 0x06;
|
|
|
Buf[2] = 0x01;
|
|
|
Buf[3] = 0x00;
|
|
|
Buf[4] = 0x00;
|
|
|
Buf[5] = 0x01;
|
|
|
Buf[6] = 0x49;
|
|
|
Buf[7] = 0xF6;
|
|
|
m_transformer.WriteBuf(Buf, 8);
|
|
|
}
|
|
|
|
|
|
Sleep(10000);
|
|
|
|
|
|
//查询所有电缸是否全部回原
|
|
|
for (auto& iter : saparateCommVec)
|
|
|
{
|
|
|
m_transformer.SetWorkMode(FALSE, 100);
|
|
|
std::string strCom = std::to_string(m_nComBaduRate);
|
|
|
strCom += ",N,8,1";
|
|
|
bool bComOpen = m_transformer.Open(iter, (char*)strCom.c_str());
|
|
|
|
|
|
bool isReturnFlag = QueryOneIsReturn(iter);
|
|
|
if (!isReturnFlag)
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
bool TransformerExport::TransformerAbsMove(TransformerPos transformerType, double distance)
|
|
|
{
|
|
|
int comm = GetCommNum(transformerType);
|
|
|
m_transformer.SetWorkMode(FALSE, 100);
|
|
|
std::string strCom = std::to_string(m_nComBaduRate);
|
|
|
strCom += ",N,8,1";
|
|
|
bool bComOpen = m_transformer.Open(comm, (char*)strCom.c_str());
|
|
|
if (transformerType == PT_TRANSFORMER || transformerType == SAPARATE_PT_TRANSFORMER)
|
|
|
{
|
|
|
return CommonOperator(distance);
|
|
|
}
|
|
|
if (transformerType == LEFT_TOP_TRANSFORMER || transformerType == RIGHT_TOP_TRANSFORMER ||
|
|
|
transformerType == LEFT_BUTTOM_TRANSFORMER || transformerType == RIGHT_BUTTOM_TRANSFORMER)
|
|
|
{
|
|
|
short moveDis = static_cast<short>(distance);
|
|
|
unsigned char Buf[8] = { 0 };
|
|
|
Buf[0] = 0x01;
|
|
|
Buf[1] = 0x06;
|
|
|
Buf[2] = 0x01;
|
|
|
Buf[3] = 0x03;
|
|
|
Buf[4] = (moveDis >> 8) & 0xFF;
|
|
|
Buf[5] = moveDis & 0xFF;
|
|
|
uint16_t crcData = CRC16_MudBus(Buf, 6);
|
|
|
Buf[6] = crcData & 0xFF;
|
|
|
Buf[7] = crcData >> 8;
|
|
|
m_transformer.WriteBuf(Buf, 8);
|
|
|
|
|
|
//读取实时位置
|
|
|
for (int i = 0; i < 30; i++)
|
|
|
{
|
|
|
//下发查询指令
|
|
|
Buf[0] = 0x01;
|
|
|
Buf[1] = 0x03;
|
|
|
Buf[2] = 0x02;
|
|
|
Buf[3] = 0x02;
|
|
|
Buf[4] = 0x00;
|
|
|
Buf[5] = 0x01;
|
|
|
Buf[6] = 0x24;
|
|
|
Buf[7] = 0x72;
|
|
|
m_transformer.WriteBuf(Buf, 8);
|
|
|
|
|
|
//获取数据
|
|
|
unsigned char readBuf[8];
|
|
|
memset(readBuf, 0, 22);
|
|
|
int length = m_transformer.ReadBuf((char*)readBuf, 8);
|
|
|
if (readBuf[0] == 0x01 && readBuf[1] == 0x03 && readBuf[2] == 0x02)
|
|
|
{
|
|
|
short getPos = (readBuf[4] << 8) | readBuf[5];
|
|
|
if (abs(getPos - moveDis) <= 5)
|
|
|
{
|
|
|
return true;
|
|
|
}
|
|
|
}
|
|
|
Sleep(1000);
|
|
|
}
|
|
|
}
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
bool TransformerExport::CommonOperator(short distance)
|
|
|
{
|
|
|
TwoBytes byteValue;
|
|
|
|
|
|
// 将 short 类型的数据拆分成两个字节
|
|
|
byteValue.bytes[0] = (distance >> 8) & 0xFF; // 高字节
|
|
|
byteValue.bytes[1] = distance & 0xFF; // 低字节
|
|
|
|
|
|
unsigned char Buf[9] = { 0 };
|
|
|
Buf[0] = 0x55;
|
|
|
Buf[1] = 0xAA;
|
|
|
Buf[2] = 0x04;
|
|
|
Buf[3] = 0x01;
|
|
|
Buf[4] = 0x21;
|
|
|
Buf[5] = 0x37;
|
|
|
Buf[6] = byteValue.bytes[1];
|
|
|
Buf[7] = byteValue.bytes[0];
|
|
|
Buf[8] = GetCheckSum(Buf, 8);
|
|
|
|
|
|
short targetPos = (Buf[7] << 8) | Buf[6];
|
|
|
|
|
|
if (m_transformer.WriteBuf(Buf, 9) < 1)
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
Sleep(500);
|
|
|
|
|
|
unsigned char readBuf[22];
|
|
|
memset(readBuf, 0, 22);
|
|
|
int length = m_transformer.ReadBuf((char*)readBuf, 22);
|
|
|
|
|
|
for (int i = 0; i < 20; i++)
|
|
|
{
|
|
|
unsigned char Buf[8] = { 0 };
|
|
|
Buf[0] = 0x55;
|
|
|
Buf[1] = 0xAA;
|
|
|
Buf[2] = 0x03;
|
|
|
Buf[3] = 0x01;
|
|
|
Buf[4] = 0x04;
|
|
|
Buf[5] = 0x00;
|
|
|
Buf[6] = 0x22;
|
|
|
Buf[7] = 0x2A;
|
|
|
|
|
|
m_transformer.WriteBuf(Buf, 8);
|
|
|
|
|
|
Sleep(200);
|
|
|
|
|
|
unsigned char readBuf[22];
|
|
|
memset(readBuf, 0, 22);
|
|
|
int length = m_transformer.ReadBuf((char*)readBuf, 22);
|
|
|
if (readBuf[0] == 0xAA && readBuf[1] == 0x55)
|
|
|
{
|
|
|
short targetPos = (readBuf[8] << 8) | readBuf[7];
|
|
|
short nowPos = (readBuf[10] << 8) | readBuf[9];
|
|
|
if (abs(targetPos - nowPos) <= 3)
|
|
|
{
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
//判断是否存在错误信息
|
|
|
if (readBuf[15] != 0x00)
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
}
|
|
|
Sleep(250);
|
|
|
}
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
unsigned char TransformerExport::GetCheckSum(unsigned char* buf, int len)
|
|
|
{
|
|
|
unsigned char checksum = 0;
|
|
|
for (int i = 2; i < len; ++i)
|
|
|
{
|
|
|
checksum += buf[i];
|
|
|
}
|
|
|
|
|
|
return checksum;
|
|
|
}
|
|
|
|
|
|
int TransformerExport::GetCommNum(TransformerPos transformerType)
|
|
|
{
|
|
|
int comm = -1;
|
|
|
switch (transformerType)
|
|
|
{
|
|
|
case PT_TRANSFORMER:
|
|
|
{
|
|
|
comm = m_debondingPTComm;
|
|
|
break;
|
|
|
}
|
|
|
case SAPARATE_PT_TRANSFORMER:
|
|
|
{
|
|
|
comm = m_saparatePTComm;
|
|
|
break;
|
|
|
}
|
|
|
case LEFT_TOP_TRANSFORMER:
|
|
|
{
|
|
|
comm = m_leftTopComm;
|
|
|
break;
|
|
|
}
|
|
|
case RIGHT_TOP_TRANSFORMER:
|
|
|
{
|
|
|
comm = m_rightTopComm;
|
|
|
break;
|
|
|
}
|
|
|
case LEFT_BUTTOM_TRANSFORMER:
|
|
|
{
|
|
|
comm = m_leftButtomComm;
|
|
|
break;
|
|
|
}
|
|
|
case RIGHT_BUTTOM_TRANSFORMER:
|
|
|
{
|
|
|
comm = m_rightButtomComm;
|
|
|
break;
|
|
|
}
|
|
|
default:
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
return comm;
|
|
|
}
|
|
|
|
|
|
uint16_t TransformerExport::CRC16_MudBus(uint8_t *puchMsg, uint8_t usDataLen)
|
|
|
{
|
|
|
uint16_t uCRC = 0xffff;//CRC寄存器
|
|
|
|
|
|
for (uint8_t num = 0; num < usDataLen; num++) {
|
|
|
uCRC = (*puchMsg++) ^ uCRC;//把数据与16位的CRC寄存器的低8位相异或，结果存放于CRC寄存器。
|
|
|
for (uint8_t x = 0; x < 8; x++) { //循环8次
|
|
|
if (uCRC & 0x0001) { //判断最低位为：“1”
|
|
|
uCRC = uCRC >> 1; //先右移
|
|
|
uCRC = uCRC ^ 0xA001; //再与0xA001异或
|
|
|
}
|
|
|
else { //判断最低位为：“0”
|
|
|
uCRC = uCRC >> 1; //右移
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
return uCRC;//返回CRC校验值
|
|
|
}
|
|
|
|
|
|
bool TransformerExport::QueryOneIsReturn(int comm)
|
|
|
{
|
|
|
//查询回原结果
|
|
|
for (int i = 0; i < 10; i++)
|
|
|
{
|
|
|
unsigned char Buf[8] = { 0 };
|
|
|
Buf[0] = 0x01;
|
|
|
Buf[1] = 0x03;
|
|
|
Buf[2] = 0x02;
|
|
|
Buf[3] = 0x00;
|
|
|
Buf[4] = 0x00;
|
|
|
Buf[5] = 0x01;
|
|
|
Buf[6] = 0x8F;
|
|
|
Buf[7] = 0xB2;
|
|
|
m_transformer.WriteBuf(Buf, 8);
|
|
|
Sleep(1000);
|
|
|
|
|
|
unsigned char readBuf[8];
|
|
|
memset(readBuf, 0, 22);
|
|
|
int length = m_transformer.ReadBuf((char*)readBuf, 8);
|
|
|
if (readBuf[0] == 0x01 && readBuf[1] == 0x03 && readBuf[2] == 0x02)
|
|
|
{
|
|
|
//校验成功
|
|
|
if (readBuf[5] == 0xB8 && readBuf[6] == 0x44)
|
|
|
{
|
|
|
Sleep(3000);
|
|
|
continue;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
return true;
|
|
|
}
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
}
|
|
|
return false;
|
|
|
}
|
