560 lines
18 KiB
C++
560 lines
18 KiB
C++
#include "comWorks.h"
|
||
#include "mainwindow.h"
|
||
#include <QtSerialPort/QSerialPort>
|
||
#include <QtSerialPort/QSerialPortInfo>
|
||
#include "QThread"
|
||
|
||
|
||
//bool connectToCom();
|
||
|
||
#define PACKET_STATE_SIZE 26
|
||
#define PACKET_SENS_SIZE 10
|
||
|
||
#define READY_FOR_READ_INT 200
|
||
|
||
extern QSerialPort *serial;
|
||
|
||
static const uint16_t Crc16Table[256] =
|
||
{
|
||
0x0000, 0xC0C1, 0xC181, 0x0140, 0xC301, 0x03C0, 0x0280, 0xC241,
|
||
0xC601, 0x06C0, 0x0780, 0xC741, 0x0500, 0xC5C1, 0xC481, 0x0440,
|
||
0xCC01, 0x0CC0, 0x0D80, 0xCD41, 0x0F00, 0xCFC1, 0xCE81, 0x0E40,
|
||
0x0A00, 0xCAC1, 0xCB81, 0x0B40, 0xC901, 0x09C0, 0x0880, 0xC841,
|
||
0xD801, 0x18C0, 0x1980, 0xD941, 0x1B00, 0xDBC1, 0xDA81, 0x1A40,
|
||
0x1E00, 0xDEC1, 0xDF81, 0x1F40, 0xDD01, 0x1DC0, 0x1C80, 0xDC41,
|
||
0x1400, 0xD4C1, 0xD581, 0x1540, 0xD701, 0x17C0, 0x1680, 0xD641,
|
||
0xD201, 0x12C0, 0x1380, 0xD341, 0x1100, 0xD1C1, 0xD081, 0x1040,
|
||
0xF001, 0x30C0, 0x3180, 0xF141, 0x3300, 0xF3C1, 0xF281, 0x3240,
|
||
0x3600, 0xF6C1, 0xF781, 0x3740, 0xF501, 0x35C0, 0x3480, 0xF441,
|
||
0x3C00, 0xFCC1, 0xFD81, 0x3D40, 0xFF01, 0x3FC0, 0x3E80, 0xFE41,
|
||
0xFA01, 0x3AC0, 0x3B80, 0xFB41, 0x3900, 0xF9C1, 0xF881, 0x3840,
|
||
0x2800, 0xE8C1, 0xE981, 0x2940, 0xEB01, 0x2BC0, 0x2A80, 0xEA41,
|
||
0xEE01, 0x2EC0, 0x2F80, 0xEF41, 0x2D00, 0xEDC1, 0xEC81, 0x2C40,
|
||
0xE401, 0x24C0, 0x2580, 0xE541, 0x2700, 0xE7C1, 0xE681, 0x2640,
|
||
0x2200, 0xE2C1, 0xE381, 0x2340, 0xE101, 0x21C0, 0x2080, 0xE041,
|
||
0xA001, 0x60C0, 0x6180, 0xA141, 0x6300, 0xA3C1, 0xA281, 0x6240,
|
||
0x6600, 0xA6C1, 0xA781, 0x6740, 0xA501, 0x65C0, 0x6480, 0xA441,
|
||
0x6C00, 0xACC1, 0xAD81, 0x6D40, 0xAF01, 0x6FC0, 0x6E80, 0xAE41,
|
||
0xAA01, 0x6AC0, 0x6B80, 0xAB41, 0x6900, 0xA9C1, 0xA881, 0x6840,
|
||
0x7800, 0xB8C1, 0xB981, 0x7940, 0xBB01, 0x7BC0, 0x7A80, 0xBA41,
|
||
0xBE01, 0x7EC0, 0x7F80, 0xBF41, 0x7D00, 0xBDC1, 0xBC81, 0x7C40,
|
||
0xB401, 0x74C0, 0x7580, 0xB541, 0x7700, 0xB7C1, 0xB681, 0x7640,
|
||
0x7200, 0xB2C1, 0xB381, 0x7340, 0xB101, 0x71C0, 0x7080, 0xB041,
|
||
0x5000, 0x90C1, 0x9181, 0x5140, 0x9301, 0x53C0, 0x5280, 0x9241,
|
||
0x9601, 0x56C0, 0x5780, 0x9741, 0x5500, 0x95C1, 0x9481, 0x5440,
|
||
0x9C01, 0x5CC0, 0x5D80, 0x9D41, 0x5F00, 0x9FC1, 0x9E81, 0x5E40,
|
||
0x5A00, 0x9AC1, 0x9B81, 0x5B40, 0x9901, 0x59C0, 0x5880, 0x9841,
|
||
0x8801, 0x48C0, 0x4980, 0x8941, 0x4B00, 0x8BC1, 0x8A81, 0x4A40,
|
||
0x4E00, 0x8EC1, 0x8F81, 0x4F40, 0x8D01, 0x4DC0, 0x4C80, 0x8C41,
|
||
0x4400, 0x84C1, 0x8581, 0x4540, 0x8701, 0x47C0, 0x4680, 0x8641,
|
||
0x8201, 0x42C0, 0x4380, 0x8341, 0x4100, 0x81C1, 0x8081, 0x4040
|
||
};
|
||
|
||
uint16_t Crc16(uint16_t len, uint16_t iobuf[]) //CRC для сообщения такой то длинны /Len - начало контрольной сумимы
|
||
{
|
||
uint16_t i;
|
||
uint16_t crc = 0xFFFF;
|
||
|
||
for(i = 0; i < len; i++) {
|
||
crc = (crc >> 8) ^ Crc16Table[(crc & 0xFF) ^ (iobuf[i]& 0xFF)];
|
||
}
|
||
return crc;
|
||
}
|
||
|
||
|
||
uint16_t Crc16(uint16_t len, QByteArray iobuf) //CRC для сообщения такой то длинны /Len - начало контрольной сумимы
|
||
{
|
||
uint16_t i;
|
||
uint16_t crc = 0xFFFF;
|
||
|
||
for(i = 0; i < len; i++) {
|
||
crc = (crc >> 8) ^ Crc16Table[(crc & 0xFF) ^ (iobuf[i] & 0xFF)]; // ввел маску 0xFF, тк прилетает 0хFFFFFFxx
|
||
}
|
||
return crc;
|
||
}
|
||
|
||
|
||
stateStruct readSet(QSerialPort *serial, uint16_t adr){
|
||
|
||
|
||
// qDebug()<<"чтение состояния";
|
||
stateStruct readed;
|
||
uint16_t recived[PACKET_STATE_SIZE]; /// поменял
|
||
uint16_t toSend[8];
|
||
toSend[0]=adr;
|
||
toSend[1]=0x3; // comand
|
||
toSend[2]=0x13;//hi addr 5001
|
||
toSend[3]=0x89; //low addr
|
||
toSend[4]=0x00; //hi regs
|
||
toSend[5]=0xb;//low regs //11 регистров
|
||
|
||
uint16_t crcToSend;
|
||
crcToSend= Crc16((uint16_t)6, toSend);
|
||
toSend[6]=LO(crcToSend);//lo CRC
|
||
toSend[7]=HI(crcToSend);//hi CRC
|
||
|
||
QByteArray readCom;
|
||
readCom.resize(8);
|
||
readCom[0]=toSend[0];
|
||
readCom[1]=toSend[1];
|
||
readCom[2]=toSend[2]; //hi addr 5001
|
||
readCom[3]=toSend[3]; //low addr
|
||
readCom[4]=toSend[4]; //hi regs
|
||
readCom[5]=toSend[5]; //low regs
|
||
readCom[6]=toSend[6]; //lo CRC
|
||
readCom[7]=toSend[7]; //hi CRC
|
||
|
||
|
||
QByteArray rec;
|
||
rec.resize(PACKET_STATE_SIZE);
|
||
|
||
serial->open(QIODevice::ReadWrite);
|
||
serial->write(readCom);
|
||
serial->waitForReadyRead(READY_FOR_READ_INT); //todo: блочное устройство, иногда читаю не все байты нужна функция приема
|
||
rec = serial->readAll();
|
||
serial->close();
|
||
|
||
|
||
for(int i=0; i<=PACKET_STATE_SIZE;i++){
|
||
recived[i]=rec.constData()[i];
|
||
}
|
||
|
||
int indNachalaCrc = recived[2]+3;
|
||
uint16_t crcRecived = Crc16(indNachalaCrc, recived); // в функции используют больше или меньше
|
||
|
||
if((recived[indNachalaCrc]&0xFF)==LO(crcRecived)&&(recived[indNachalaCrc+1]&0xFF)==HI(crcRecived)){ //todo внимание костыль
|
||
qDebug()<<"чтение состояния CRC Ок ";
|
||
readed.crcOk = true;
|
||
}else{
|
||
qDebug()<<"чтение состояния CRC не катит";
|
||
readed.crcOk = false;
|
||
}
|
||
|
||
|
||
readed.fn=(typeIFN)recived[8];
|
||
readed.fv=(typeIFV)recived[6];
|
||
readed.in=(typeIIN)recived[2]; //!!!шляпа он точно не второй
|
||
readed.ku=(typeIKU)recived[10];
|
||
readed.unit=(typeUnit)recived[22];
|
||
readed.overload=(typeOverload)recived[24];
|
||
readed.pz=(typePlavGround)recived[18];
|
||
|
||
return readed;
|
||
};
|
||
|
||
sensStruct readSens(QSerialPort *serial,uint16_t adr){ //todo: неплохо если ты посчитаешь контрольные суммы, Дима.
|
||
|
||
// qDebug()<<"Сработало чтение чувствительности";
|
||
sensStruct result;
|
||
usfloat res;
|
||
res.ch[0] =0;
|
||
res.ch[1] =0;
|
||
res.ch[2] =0;
|
||
res.ch[3] =0;
|
||
//структура на отправку
|
||
uint16_t toSend[8]={0,};
|
||
uint16_t recived[25]={0,};
|
||
toSend[0]=adr;
|
||
toSend[1]=0x3; // comand
|
||
|
||
toSend[2]=0x1b;//hi addr 7004
|
||
toSend[3]=0x5c; //low addr 7004
|
||
|
||
toSend[4]=0x00; //hi regs
|
||
toSend[5]=0x02;//low regs
|
||
uint16_t crc = Crc16(6, toSend);
|
||
toSend[6]=LO(crc);//lo CRC
|
||
toSend[7]=HI(crc);//hi CRC
|
||
|
||
QByteArray readCom;
|
||
readCom.resize(8);
|
||
|
||
readCom[0]=toSend[0];
|
||
readCom[1]=toSend[1];
|
||
readCom[2]=toSend[2]; //hi addr 5001
|
||
readCom[3]=toSend[3]; //low addr
|
||
readCom[4]=toSend[4]; //hi regs
|
||
readCom[5]=toSend[5]; //low regs
|
||
readCom[6]=toSend[6]; //lo CRC
|
||
readCom[7]=toSend[7]; //hi CRC
|
||
|
||
QByteArray rec;
|
||
rec.resize(PACKET_SENS_SIZE);
|
||
serial->open(QIODevice::ReadWrite); // открыли порт на запись и чтение
|
||
serial->write(readCom);
|
||
serial->waitForReadyRead(READY_FOR_READ_INT);
|
||
rec = serial->readAll();
|
||
serial->close();
|
||
|
||
|
||
|
||
for(int i=0; i<PACKET_SENS_SIZE;i++){
|
||
recived[i]=rec.constData()[i];
|
||
}
|
||
|
||
int indNachalaCrc = recived[2]+3; //todo: проверить
|
||
uint16_t crcRecived = Crc16(indNachalaCrc, recived); // в функции используют больше или меньше
|
||
|
||
|
||
|
||
if((recived[indNachalaCrc]&0xFF)==LO(crcRecived)&&(recived[indNachalaCrc+1]&0xFF)==HI(crcRecived)){ //todo внимание костыль
|
||
result.crcOk =true;
|
||
}else{
|
||
result.crcOk =false;
|
||
}
|
||
|
||
res.ch[3]=recived[3]; // Собираю флоат
|
||
res.ch[2]=recived[4];
|
||
res.ch[1]=recived[5];
|
||
res.ch[0]=recived[6];
|
||
|
||
qDebug()<<(float)res.fl;
|
||
result.sens =res.fl;
|
||
return result;
|
||
}
|
||
|
||
|
||
|
||
bool writePalam(QSerialPort *serial, uint16_t adr, typeParam typeparam, uint16_t value)
|
||
{
|
||
QByteArray writeCom;
|
||
writeCom.resize(11);
|
||
writeCom[0]=adr;
|
||
writeCom[1]=0x10; // comand
|
||
|
||
switch (typeparam) {
|
||
|
||
case in:
|
||
writeCom[2]=0x13;//hi addr 5001
|
||
writeCom[3]=0x89; //low addr5001
|
||
break;
|
||
|
||
case ku:
|
||
writeCom[2]=0x13;//hi addr 5004
|
||
writeCom[3]=0x8c; //low addr5004
|
||
break;
|
||
|
||
case fv:
|
||
writeCom[2]=0x13;//hi addr 5002
|
||
writeCom[3]=0x8a; //low addr5002
|
||
break;
|
||
|
||
case fn:
|
||
writeCom[2]=0x13;//hi addr 5003
|
||
writeCom[3]=0x8b; //low addr5003
|
||
break;
|
||
|
||
case unit:
|
||
writeCom[2]=0x13;//hi addr 5010
|
||
writeCom[3]=0x92; //low addr5010
|
||
break;
|
||
|
||
|
||
case overload:
|
||
writeCom[2]=0x13;//hi addr 5011
|
||
writeCom[3]=0x93; //low addr5011
|
||
break;
|
||
|
||
case pz:
|
||
writeCom[2]=0x13;//hi addr 5008
|
||
writeCom[3]=0x90; //low addr5008
|
||
break;
|
||
|
||
default:
|
||
qDebug() << "передано неверное значение типа параметра";
|
||
break;
|
||
|
||
}
|
||
|
||
//пишем по одномк регистру
|
||
writeCom[4]=0x00; //hi regs
|
||
writeCom[5]=0x1;//low regs
|
||
writeCom[6]=0x2;// байт на отправку
|
||
writeCom[7]=0;
|
||
writeCom[8]=value; //значение на отправку
|
||
|
||
uint16_t crcToSend;
|
||
crcToSend= Crc16((uint16_t)9, writeCom); //длинна захардкожена //Возможно будет неправильно считать
|
||
writeCom[9]=LO(crcToSend);//lo CRC
|
||
writeCom[10]=HI(crcToSend);//hi CRC
|
||
|
||
|
||
qDebug()<<QByteArray::number(writeCom[0], 16)<< "adr";
|
||
qDebug()<<QByteArray::number(writeCom[1], 16)<< "comand";
|
||
qDebug()<<QByteArray::number(writeCom[2], 16)<< "adr reg HI";
|
||
qDebug()<<QByteArray::number(writeCom[3], 16)<< "adr reg LO";
|
||
qDebug()<<QByteArray::number(writeCom[4], 16)<< "num reg HI";
|
||
qDebug()<<QByteArray::number(writeCom[5], 16)<< "num reg Lo";
|
||
qDebug()<<QByteArray::number(writeCom[6], 16)<< "num reg bytes";
|
||
qDebug()<<QByteArray::number(writeCom[7], 16)<< "num reg HI data";
|
||
qDebug()<<QByteArray::number(writeCom[8], 16)<< "num reg LO data";
|
||
qDebug()<<QByteArray::number(writeCom[9], 16)<< " LO CRC ";
|
||
qDebug()<<QByteArray::number(writeCom[10], 16)<< "CRC HI";
|
||
|
||
serial->open(QIODevice::ReadWrite);
|
||
serial->write(writeCom);
|
||
serial->waitForReadyRead(READY_FOR_READ_INT);
|
||
|
||
|
||
QByteArray rec;
|
||
rec = serial->readAll();
|
||
|
||
qDebug()<<rec.toHex();
|
||
|
||
serial->close();
|
||
|
||
|
||
return 1;
|
||
}
|
||
|
||
bool writeSens(QSerialPort *serial, uint16_t adr, float value)
|
||
{
|
||
QByteArray writeCom;
|
||
writeCom.resize(11);
|
||
writeCom[0]=adr;
|
||
writeCom[1]=0x10; // comand
|
||
writeCom[2]=0x1b;//hi addr 7004
|
||
writeCom[3]=0x5c; //low addr 7004
|
||
writeCom[4]=0x00; //hi regs
|
||
writeCom[5]=0x2;//low regs
|
||
writeCom[6]=0x4;// байт на отправку //а не 2=)
|
||
|
||
usfloat res;
|
||
res.fl=value;
|
||
|
||
writeCom[7]=res.ch[3]&0xFF; // Собираю флоат
|
||
writeCom[8]=res.ch[2]&0xFF;
|
||
writeCom[9]=res.ch[1]&0xFF;
|
||
writeCom[10]=res.ch[0]&0xFF;
|
||
|
||
uint16_t crcToSend;
|
||
crcToSend= Crc16((uint16_t)11, writeCom); //длинна захардкожена //Возможно будет неправильно считать
|
||
writeCom[11]=(LO(crcToSend)&0xFF);//lo CRC
|
||
writeCom[12]=(HI(crcToSend)&0xFF);//hi CRC
|
||
|
||
qDebug()<<writeCom.toHex(); // с этой шляпой всё работает
|
||
|
||
qDebug()<<QByteArray::number(writeCom[0], 16)<< "adr";
|
||
qDebug()<<QByteArray::number(writeCom[1], 16)<< "comand";
|
||
qDebug()<<QByteArray::number(writeCom[2], 16)<< "reg HI";
|
||
qDebug()<<QByteArray::number(writeCom[3], 16)<< "adr reg LO";
|
||
qDebug()<<QByteArray::number(writeCom[4], 16)<< "num reg HI";
|
||
qDebug()<<QByteArray::number(writeCom[5], 16)<< "num reg Lo";
|
||
qDebug()<<QByteArray::number(writeCom[6], 16)<< "num reg bytes";
|
||
qDebug()<<QByteArray::number(writeCom[7], 16)<< "HI data";
|
||
qDebug()<<QByteArray::number(writeCom[8], 16)<< "LO data";
|
||
qDebug()<<QByteArray::number(writeCom[9], 16)<< "HI data";
|
||
qDebug()<<QByteArray::number(writeCom[10], 16)<< "LO data";
|
||
qDebug()<<QByteArray::number(writeCom[11], 16)<< " LO CRC ";
|
||
qDebug()<<QByteArray::number(writeCom[12], 16)<< "CRC HI";
|
||
|
||
|
||
|
||
serial->open(QIODevice::ReadWrite);
|
||
serial->write(writeCom);
|
||
serial->waitForReadyRead(READY_FOR_READ_INT);
|
||
|
||
QByteArray rec;
|
||
rec = serial->readAll();
|
||
|
||
|
||
|
||
qDebug()<<rec.toHex();
|
||
|
||
serial->close();
|
||
|
||
return 1;
|
||
|
||
}
|
||
|
||
|
||
bool writeConSet(QSerialPort *serial, uint16_t adrCurrent,
|
||
uint16_t adrNew, uint32_t new_speed, Parity parity)
|
||
{
|
||
QByteArray writeCom;
|
||
writeCom.resize(11);
|
||
writeCom[0]=adrCurrent;
|
||
writeCom[1]=0x10; // comand
|
||
writeCom[2]=0xf;//hi addr 4001
|
||
writeCom[3]=0xa1; //low addr 4001
|
||
writeCom[4]=0x00; //hi regs
|
||
writeCom[5]=0x3;//low regs
|
||
writeCom[6]=0x6;// байт на отправку
|
||
|
||
writeCom[7]=0x0;
|
||
writeCom[8]=adrNew; //новый адрес
|
||
|
||
writeCom[9]=0x0;
|
||
|
||
switch (new_speed) {
|
||
case 4800:
|
||
writeCom[10]=0x0; //скорость
|
||
break;
|
||
case 7200:
|
||
writeCom[10]=0x1; //скорость
|
||
break;
|
||
case 9600:
|
||
writeCom[10]=0x2; //скорость
|
||
break;
|
||
case 14400:
|
||
writeCom[10]=0x3; //скорость
|
||
break;
|
||
case 19200:
|
||
writeCom[10]=0x4; //скорость
|
||
break;
|
||
case 38400:
|
||
writeCom[10]=0x5; //скорость
|
||
break;
|
||
case 57600:
|
||
writeCom[10]=0x6; //скорость
|
||
break;
|
||
case 115200:
|
||
writeCom[10]=0x7; //скорость
|
||
break;
|
||
case 128000:
|
||
writeCom[10]=0x8; //скорость
|
||
break;
|
||
case 230400:
|
||
writeCom[10]=0x9; //скорость
|
||
break;
|
||
default:
|
||
qDebug()<<"Со скоростью беда";
|
||
break;
|
||
}
|
||
writeCom[11]=0x0;
|
||
switch (parity) {
|
||
case UART_PARITY_NONE:
|
||
writeCom[12]=0x0;
|
||
break;
|
||
case UART_PARITY_ODD:
|
||
writeCom[12]=0x1;
|
||
break;
|
||
case UART_PARITY_EVEN:
|
||
writeCom[12]=0x2;
|
||
break;
|
||
}
|
||
//бит четности
|
||
|
||
|
||
uint16_t crcToSend;
|
||
crcToSend= Crc16((uint16_t)13, writeCom); //длинна захардкожена //Возможно будет неправильно считать
|
||
writeCom[13]=(LO(crcToSend)&0xFF);//lo CRC
|
||
writeCom[14]=(HI(crcToSend)&0xFF);//hi CRC
|
||
|
||
|
||
qDebug()<<writeCom.toHex(); // с этой шляпой всё работает
|
||
|
||
qDebug()<<QByteArray::number(writeCom[0], 16)<< "adr";
|
||
qDebug()<<QByteArray::number(writeCom[1], 16)<< "comand";
|
||
qDebug()<<QByteArray::number(writeCom[2], 16)<< "reg HI";
|
||
qDebug()<<QByteArray::number(writeCom[3], 16)<< "adr reg LO";
|
||
qDebug()<<QByteArray::number(writeCom[4], 16)<< "num reg HI";
|
||
qDebug()<<QByteArray::number(writeCom[5], 16)<< "num reg Lo";
|
||
qDebug()<<QByteArray::number(writeCom[6], 16)<< "num reg bytes";
|
||
qDebug()<<QByteArray::number(writeCom[7], 16)<< "HI data";
|
||
qDebug()<<QByteArray::number(writeCom[8], 16)<< "LO data";
|
||
qDebug()<<QByteArray::number(writeCom[9], 16)<< "HI data";
|
||
qDebug()<<QByteArray::number(writeCom[10], 16)<< "LO data";
|
||
qDebug()<<QByteArray::number(writeCom[11], 16)<< "HI data";
|
||
qDebug()<<QByteArray::number(writeCom[12], 16)<< "LO data";
|
||
qDebug()<<QByteArray::number(writeCom[13], 16)<< " LO CRC ";
|
||
qDebug()<<QByteArray::number(writeCom[14], 16)<< "CRC HI";
|
||
|
||
|
||
serial->open(QIODevice::ReadWrite);
|
||
serial->write(writeCom);
|
||
serial->waitForReadyRead(READY_FOR_READ_INT);
|
||
QByteArray rec;
|
||
rec = serial->readAll();
|
||
|
||
qDebug()<<rec.toHex();
|
||
|
||
serial->close();
|
||
if(((rec[0]&0xFF)==adrCurrent) && ((rec[1]&0xFF)==0x10)) return NO_ERROR;
|
||
else return ERROR;
|
||
|
||
}
|
||
|
||
|
||
sensStruct readSensTest(QSerialPort *serial, uint16_t adr)
|
||
{
|
||
|
||
|
||
sensStruct result;
|
||
usfloat res;
|
||
res.ch[0] =0;
|
||
res.ch[1] =0;
|
||
res.ch[2] =0;
|
||
res.ch[3] =0;
|
||
//структура на отправку
|
||
uint16_t toSend[8]={0,};
|
||
uint16_t recived[25]={0,};
|
||
toSend[0]=adr;
|
||
toSend[1]=0x3; // comand
|
||
|
||
//Если мы хотим читать 7502 - то нужно увеличить размер
|
||
//toSend[2]=0x1d;//hi addr 7502
|
||
//toSend[3]=0x4e; //low addr 7502
|
||
|
||
toSend[2]=0x1b;//hi addr 7004
|
||
toSend[3]=0x5c; //low addr 7004
|
||
|
||
toSend[4]=0x00; //hi regs
|
||
toSend[5]=0x02;//low regs
|
||
uint16_t crc = Crc16(6, toSend);
|
||
toSend[6]=LO(crc);//lo CRC
|
||
toSend[7]=HI(crc);//hi CRC
|
||
|
||
QByteArray readCom;
|
||
readCom.resize(8);
|
||
// uint16_t crc = Crc16(5);
|
||
readCom[0]=toSend[0];
|
||
readCom[1]=toSend[1];
|
||
readCom[2]=toSend[2]; //hi addr 5001
|
||
readCom[3]=toSend[3]; //low addr
|
||
readCom[4]=toSend[4]; //hi regs
|
||
readCom[5]=toSend[5]; //low regs
|
||
readCom[6]=toSend[6]; //lo CRC
|
||
readCom[7]=toSend[7]; //hi CRC
|
||
|
||
serial->open(QIODevice::ReadWrite); // открыли порт на запись и чтение
|
||
serial->write(readCom);
|
||
serial->waitForReadyRead(READY_FOR_READ_INT);
|
||
|
||
QByteArray rec;
|
||
rec.resize(PACKET_SENS_SIZE);
|
||
rec = serial->readAll();
|
||
serial->close();
|
||
|
||
|
||
|
||
for(int i=0; i<PACKET_SENS_SIZE;i++){
|
||
recived[i]=rec.constData()[i];
|
||
}
|
||
|
||
int indNachalaCrc = recived[2]+3; //todo: проверить
|
||
uint16_t crcRecived = Crc16(indNachalaCrc, recived); // в функции используют больше или меньше
|
||
// qDebug()<<QString("Начало CRC в пакете %1").arg(indNachalaCrc);
|
||
// qDebug()<<QString("ожидаемая CRC %1%2").arg(LO(crcRecived), 0, 16).arg(HI(crcRecived), 0, 16);
|
||
// qDebug()<<QString("Прибывшая CRC %1%2").arg(recived[indNachalaCrc], 0, 16).arg(recived[indNachalaCrc+1], 0, 16);
|
||
|
||
//если CRC Норм ставим зеленый
|
||
if((recived[indNachalaCrc]&0xFF)==LO(crcRecived)&&(recived[indNachalaCrc+1]&0xFF)==HI(crcRecived)){ //todo внимание костыль
|
||
result.crcOk =true;
|
||
qDebug()<<"Чтение чувуствительности CRC Ок";
|
||
}else{
|
||
qDebug()<<"Чтение чувуствительности CRC не катит";
|
||
result.crcOk =false;
|
||
}
|
||
|
||
|
||
res.ch[3]=recived[3]; // Собираю флоат
|
||
res.ch[2]=recived[4];
|
||
res.ch[1]=recived[5];
|
||
res.ch[0]=recived[6];
|
||
|
||
qDebug()<<(float)res.fl;
|
||
result.sens =res.fl;
|
||
return result;
|
||
}
|