#ifndef CS19_H
#define CS19_H
#include <QFile>
const quint8 MAX_S19_LINE_COUNT_LENGHT = 76;
const quint8 MIN_S19_LINE_COUNT_LENGHT = 10;
const quint8 MAX_S19_LINE_LENGHT = 156;
typedef enum __tagS19ErrorCode
{
S19_NO_ERROR = 0,
S19_FORMAT_ERROR,
S19_VERIFY_ERROR,
S19_LENGHT_ERROR,
S19_USERPAPR_EEROR,
}ES19ErrorCode;
typedef enum __tagS19Type
{
S0 = 0,
S1,
S2,
S3,
S5,
S7,
S8,
S9,
S_MAX,
}emS19Type;
typedef struct __tagS19LineData
{
emS19Type type;
quint8 count;
quint32 address;
quint8 data[100];
quint8 checksum;
quint8 datalen;
}stS19LineData;
class CS19
{
public:
CS19();
ES19ErrorCode getS19LineData(QByteArray bydata,stS19LineData *p);
private:
char ConvertHexChar(char ch);
};
#endif // CS19_H
#include "Cs19.h"
const QString S19TypeTable[8] =
{
"S0","S1","S2","S3","S5","S7","S8","S9"
};
CS19::CS19()
{
}
char CS19::ConvertHexChar(char ch)
{
if((ch >= '0') && (ch <= '9'))
return (ch-0x30);
else if((ch >= 'A') && (ch <= 'F'))
return ((ch-'A')+10);
else if((ch >= 'a') && (ch <= 'f'))
return ((ch-'a')+10);
else return (-1);
}
ES19ErrorCode CS19::getS19LineData(QByteArray bydata,stS19LineData *p)
{
quint16 i = 0;
quint8 cs_temp = 0;
QString str(bydata);
char *pcdata = bydata.data();
quint32 linelen = str.size();
if(linelen < MIN_S19_LINE_COUNT_LENGHT)
{
qDebug("S19_LENGHT_ERROR");
return S19_LENGHT_ERROR;
}
//获取Type
QString stype = str.mid(0,2);
for(i = 0; i < S_MAX; i++)
{
if(stype == S19TypeTable[i])
{
p->type = (emS19Type)i;
break;
}
}
if(i == S_MAX) {qDebug("S19_FORMAT_ERROR");return S19_FORMAT_ERROR;}
//获取count
p->count = (ConvertHexChar(*(pcdata + 2)) << 4) | ConvertHexChar(*(pcdata + 3));
cs_temp += p->count;
if(p->count != ((linelen / 2) - 3))
{
qDebug("S19_FORMAT_ERROR");
return S19_FORMAT_ERROR;
}
//获取address
if(p->type == S0)//2 Bytes:0x0000填充
{
p->address = 0x0;
}
else if((p->type == S1) || (p->type == S5) || (p->type == S9))//2 Bytes
{
p->address = (ConvertHexChar(*(pcdata + 4)) << 12) | \
(ConvertHexChar(*(pcdata + 5)) << 8) | \
(ConvertHexChar(*(pcdata + 6)) << 4) | \
(ConvertHexChar(*(pcdata + 7)));
cs_temp += (p->address >> 8) & 0x0FF;
cs_temp += p->address & 0x0FF;
//获取data
for(i = 0; i < p->count - 3; i++)
{
p->data[i] = (ConvertHexChar(*(pcdata + 2*i + 8)) << 4) | ConvertHexChar(*(pcdata + 2*i + 9));
cs_temp += p->data[i];
}
//获取checksum
p->checksum = (ConvertHexChar(*(pcdata + 2*i + 8)) << 4) | ConvertHexChar(*(pcdata + 2*i + 9));
if(p->checksum != (0xFF - cs_temp))
{
qDebug("S19_VERIFY_ERROR");
return S19_VERIFY_ERROR;
}
}
else if((p->type == S2) || (p->type == S8))//3 Bytes
{
p->address = (ConvertHexChar(*(pcdata + 4)) << 20) | \
(ConvertHexChar(*(pcdata + 5)) << 16) | \
(ConvertHexChar(*(pcdata + 6)) << 12) | \
(ConvertHexChar(*(pcdata + 7)) << 8) | \
(ConvertHexChar(*(pcdata + 8)) << 4) | \
(ConvertHexChar(*(pcdata + 9)));
cs_temp += (p->address >> 16) & 0x0FF;
cs_temp += (p->address >> 8) & 0x0FF;
cs_temp += p->address & 0x0FF;
//获取data
for(i = 0; i < p->count - 4; i++)
{
p->data[i] = (ConvertHexChar(*(pcdata + 2*i + 10)) << 4) | ConvertHexChar(*(pcdata + 2*i + 11));
cs_temp += p->data[i];
}
//获取checksum
p->checksum = (ConvertHexChar(*(pcdata + 2*i + 10)) << 4) | ConvertHexChar(*(pcdata + 2*i + 11));
if(p->checksum != (0xFF - cs_temp))
{
qDebug("S19_VERIFY_ERROR");
return S19_VERIFY_ERROR;
}
}
else if((p->type == S3) || (p->type == S7))//4 Bytes
{
p->address = (ConvertHexChar(*(pcdata + 4)) << 28) | \
(ConvertHexChar(*(pcdata + 5)) << 24) | \
(ConvertHexChar(*(pcdata + 6)) << 20) | \
(ConvertHexChar(*(pcdata + 7)) << 16) | \
(ConvertHexChar(*(pcdata + 8)) << 12) | \
(ConvertHexChar(*(pcdata + 9)) << 8) | \
(ConvertHexChar(*(pcdata + 10)) << 4) | \
(ConvertHexChar(*(pcdata + 11)));
cs_temp += (p->address >> 24) & 0x0FF;
cs_temp += (p->address >> 16) & 0x0FF;
cs_temp += (p->address >> 8) & 0x0FF;
cs_temp += p->address & 0x0FF;
//获取data
for(i = 0; i < p->count - 5; i++)
{
p->data[i] = (ConvertHexChar(*(pcdata + 2*i + 12)) << 4) | ConvertHexChar(*(pcdata + 2*i + 13));
cs_temp += p->data[i];
}
//获取checksum
p->checksum = (ConvertHexChar(*(pcdata + 2*i + 12)) << 4) | ConvertHexChar(*(pcdata + 2*i + 13));
if(p->checksum != (0xFF - cs_temp))
{
qDebug("S19_VERIFY_ERROR");
return S19_VERIFY_ERROR;
}
}
//获取datalen
//if(p->type == S0) p->datalen = p->count - 3;
if(p->type == S1) p->datalen = p->count - 3;
else if(p->type == S2) p->datalen = p->count - 4;
else if(p->type == S3) p->datalen = p->count - 5;
else p->datalen = 0;
return S19_NO_ERROR;
}