hlp/VX5_KRO_GearPump
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

压力算法移植前

Browse Source
This commit is contained in:
byons
2026-06-29 14:54:30 +08:00
parent 507781d127
commit ef2eecf972
1652 changed files with 312373 additions and 29 deletions
Download Patch File Download Diff File Expand all files Collapse all files
oldProject/rfid/rfidfunction.cpp
+645
View File
@@ -0,0 +1,645 @@
#include "rfidfunction.h"
#include "sm3.h"
#include "sm4.h"
#include <QTime>
#include <QCoreApplication>
// 计算校验和并输出
void RFIDFunction::CheckSumOut(unsigned char* buf, unsigned char len)
{
unsigned char i;
unsigned char checksum;
checksum = 0;
for (i = 0; i < (len - 1); i++)
{
checksum ^= buf[i]; // 逐位异或计算校验和
}
buf[len - 1] = (unsigned char)~checksum; // 取反作为校验和
}
// 检查输入的校验和是否正确
bool RFIDFunction::CheckSumIn(unsigned char* buf, unsigned char len)
{
unsigned char i;
unsigned char checksum;
checksum = 0;
for (i = 0; i < (len - 1); i++)
{
checksum ^= buf[i]; // 逐位异或计算校验和
}
if (buf[len - 1] == (unsigned char)~checksum) // 比较校验和
{
return true; // 校验和正确
}
return false; // 校验和错误
}
// 将十六进制字符串转换为字节数组
void hexStrToByte(const QByteArray& hexIn, unsigned char* dest)
{
int sourceLen = hexIn.size();
unsigned char* source = (unsigned char*)hexIn.constData();
short i;
unsigned char highByte, lowByte;
for (i = 0; i < sourceLen; i += 2)
{
highByte = toupper(source[i]); // 高位
lowByte = toupper(source[i + 1]); // 低位
if (highByte > 0x39)
{
highByte -= 0x37; // A-F转换
}
else
{
highByte -= 0x30; // 0-9转换
}
if (lowByte > 0x39)
{
lowByte -= 0x37; // A-F转换
}
else
{
lowByte -= 0x30; // 0-9转换
}
dest[i / 2] = (highByte << 4) | lowByte; // 合并高低位
}
return;
}
// 检测输入的字符是否是有效的16进制字符
bool isValidHex(const QByteArray& input)
{
int length = input.size(); // 获取输入的长度
for (int i = 0; i < length; ++i) // 使用传统的for循环
{
char c = input[i]; // 获取当前字符
// 检查字符是否在0-9, A-F, a-f范围内
if (!((c >= '0' && c <= '9') ||
(c >= 'A' && c <= 'F') ||
(c >= 'a' && c <= 'f')))
{
return false; // 如果有无效字符，返回false
}
}
return true; // 所有字符均有效，返回true
}
void sleepMs(unsigned int msec)
{
QTime dieTime = QTime::currentTime().addMSecs(msec);
while( QTime::currentTime() < dieTime )
QCoreApplication::processEvents(QEventLoop::AllEvents, 100);
}
RFIDFunction::RFIDFunction(QObject *parent)
: QObject(parent),m_SerialPort(NULL)
{
m_SerialSate = initSerialPortAndOpen("COM3"); // 初始化串口
}
RFIDFunction::~RFIDFunction()
{
if (m_SerialPort) {
if (m_SerialPort->isOpen()) {
m_SerialPort->close();
}
delete m_SerialPort;
m_SerialPort = nullptr;
}
}
/***
* @描述 : 创建读写卡的密码（Key_A和Key_B）
* @入参 : info 生成密码的数据
* @输出 : 无
* @返回 : 密钥的原始数据
*/
const QByteArray RFIDFunction::createPassword(const QByteArray& info)
{
if (info.isEmpty())
{
return ""; // 如果输入为空，返回空
}
int inputSize = info.size();
if (inputSize > 8192)
{
return ""; // 如果输入大小超过限制，返回空
}
//先用SM3对原始数据进行哈希生成
unsigned char hashDataOrigin[32] = { 0 };
SM3::sm3Hash((unsigned char*)info.data(), inputSize, hashDataOrigin); // 生成哈希
//接着使用哈希生成SM4加密密钥
unsigned char sm4Key[16] = { 0 };
unsigned char sm4IV[16] = { 0 };
int index_1 = 0;
int index_2 = 0;
for (int i = 0; i < 32; i++)
{
if (i % 2 == 0)
{
sm4Key[index_1++] = hashDataOrigin[i]; // 偶数位作为SM4密钥
}
else
{
sm4IV[index_2++] = hashDataOrigin[i]; // 奇数位作为SM4初始向量
}
}
//再用SM4对原始数据进行加密
unsigned char out[8192] = {0};
sm4_context sm4Ctx;
SM4::sm4_setkey_enc(&sm4Ctx, sm4Key); // 设置SM4加密密钥
SM4::sm4_crypt_cbc(&sm4Ctx, SM4_ENCRYPT, inputSize, sm4IV, (unsigned char*)info.data(), out); // 执行SM4加密
//最后再用SM3对加密后的数据取哈希
unsigned char hashEncrypted[32] = { 0 };
SM3::sm3Hash(out, inputSize, hashEncrypted); // 生成加密数据的哈希
index_1 = 0;
char key[16] = { 0 };
for (int i = 0; i < 32; i++)
{
if (i % 2 != 0)//取哈希的奇数位作为最终的密码
{
key[index_1++] = hashEncrypted[i];
}
}
return QByteArray(key,16).toHex(); // 返回最终的密码
}
bool RFIDFunction::getSerialState()
{
return m_SerialSate; // 返回串口状态
}
RFIDFunction::ErrorCode RFIDFunction::initSerialPortAndOpen(const QString& portName,
BaudRateType baudRate,
DataBitsType setDataBits,
StopBitsType stopBits,
ParityType parity)
{
m_SerialPort = new Posix_QextSerialPort("/dev/ttyO3",QextSerialBase::Polling); // 创建串口对象
m_SerialPort->setPortName(portName); // 设置串口名称
m_SerialPort->setBaudRate((BaudRateType)baudRate); // 设置波特率
m_SerialPort->setDataBits(setDataBits); // 设置数据位
m_SerialPort->setStopBits(stopBits); // 设置停止位
m_SerialPort->setParity(parity); // 设置校验位
m_SerialPort->setFlowControl(FLOW_OFF);
if (m_SerialPort->open(QIODevice::ReadWrite)) // 打开串口
{
return Serial_Error; // 打开失败，返回串口错误
}
return No_Error; // 打开成功，返回无错误
}
RFIDFunction::ErrorCode RFIDFunction::setOriginPassword(const QByteArray& psw)
{
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x03; // 命令头
com[1] = 0x0B; // 数据长度
com[2] = 0xC4; // 命令类型
com[3] = 0x20; // 额外数据
unsigned char hexOut[32] = { 0 }; // 存储转换后的十六进制数据
hexStrToByte(psw, hexOut); // 将密码转换为字节数组
memcpy(com + 4, hexOut, 6); // 将密码添加到命令中
CheckSumOut(com, com[1]); // 计算校验和
//QByteArray AAA = QByteArray((char*)com, com[1]).toHex(); // 转换为十六进制字符串
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x03) && (revData[1] == 0x08) && (revData[2] == 0xC4) && (revData[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
RFIDFunction::ErrorCode RFIDFunction::setWriteAndReadPassword(const QByteArray& writePassword, const QByteArray& readPassword, KeyFunction keyFunc)
{
if (writePassword.isEmpty() || readPassword.isEmpty())
{
return Data_Is_Empty_Error; // 如果密码为空，返回错误
}
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x03; // 命令头
com[1] = 0x15; // 数据长度
com[2] = 0xC3; // 命令类型
com[3] = 0x20; // 额外数据
unsigned char hexOut[32] = { 0 }; // 存储转换后的十六进制数据
hexStrToByte(writePassword.toHex(), hexOut); // 将写密码转换为字节数组
memcpy(com + 4, hexOut, 6); // 将写密码添加到命令中
switch (keyFunc) // 根据密钥功能设置命令
{
case RFIDFunction::KeyA_Same_KeyB:
/*
* 控制如下：KEYA,KEYB 可以用来读 、写 、增值 、减值 、更改扇区密钥
*/
com[10] = 0xFF; // 设置KEYA和KEYB相同
com[11] = 0x07; // 设置权限
com[12] = 0x80; // 设置操作
com[13] = 0x69; // 设置结束标志
break;
case RFIDFunction::KeyB_Control_KeyA:
/*
控制如下：KEYA 可以读数据块 、减值 、查询余额
KEYB 可以读写数据块 、增值 、减值 、查询余额
KEYA 、KEYB 不可读，KEYA，KEYB 由 KEYB 修改
*/
com[10] = 0x08; // 设置KEYB控制KEYA
com[11] = 0x77; // 设置权限
com[12] = 0x8F; // 设置操作
com[13] = 0x69; // 设置结束标志
break;
default:
break;
}
memset(hexOut, 0, 32); // 清空hexOut
hexStrToByte(readPassword.toHex(), hexOut); // 将读密码转换为字节数组
memcpy(com + 14, hexOut, 6); // 将读密码添加到命令中
CheckSumOut(com, com[1]); // 计算校验和
QByteArray AAA = QByteArray((char*)com, com[1]).toHex(); // 转换为十六进制字符串
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x03) && (revData[1] == 0x08) && (revData[2] == 0xC3) && (revData[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
RFIDFunction::ErrorCode RFIDFunction::setEncryptedBlock(KeyType type, ControlBlock block)
{
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x01; // 命令头
com[1] = 0x08; // 数据长度
switch (type)//只有两种密码，A和B
{
case RFIDFunction::KEY_A:
com[2] = 0xA5; // 设置为KEY_A
break;
case RFIDFunction::KEY_B:
com[2] = 0x5A; // 设置为KEY_B
break;
default:
com[2] = 0xA5; // 默认设置为KEY_A
break;
}
com[3] = 0x20; // 额外数据
memcpy(com + 4, &block, 1); // 将加密块添加到命令中
com[5] = 0x01;//蜂鸣器开 0x00不开
com[6] = 0x00;//保留
CheckSumOut(com, com[1]); // 计算校验和
QByteArray AAA = QByteArray((char*)com, com[1]).toHex(); // 转换为十六进制字符串
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x01) && (revData[1] == 0x08) && (revData[2] == com[2]) && (revData[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
RFIDFunction::ErrorCode RFIDFunction::writeDataToBlock(KeyType type, DataBlock block, const QByteArray& data)
{
if (data.isEmpty())
{
return Data_Is_Empty_Error; // 如果数据为空，返回错误
}
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x01; // 命令头
com[1] = 0x17; // 数据长度
switch (type)//只有两种密码，A和B
{
case RFIDFunction::KEY_A:
com[2] = 0xA4; // 设置为KEY_A
break;
case RFIDFunction::KEY_B:
com[2] = 0x5B; // 设置为KEY_B
break;
default:
com[2] = 0xA4; // 默认设置为KEY_A
break;
}
com[3] = 0x20; // 额外数据
memcpy(com + 4, &block, 1); // 将数据块添加到命令中
com[5] = 0x01;//蜂鸣器开 0x00不开
unsigned char hexOut[32] = { 0 }; // 存储转换后的十六进制数据
memset(hexOut, 0, 32); // 清空hexOut
if (!isValidHex(data)) // 检查数据是否合法
{
return Data_Is_Illegal_Error; // 数据非法
}
hexStrToByte(data, hexOut); // 将数据转换为字节数组
memcpy(com + 6, hexOut, 16); // 将数据添加到命令中
CheckSumOut(com, com[1]); // 计算校验和
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x01) && (revData[1] == 0x08) && (revData[2] == com[2]) && (revData[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
RFIDFunction::ErrorCode RFIDFunction::readDataFromBlock(KeyType type, DataBlock block, QByteArray& data)
{
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x01; // 命令头
com[1] = 0x08; // 数据长度
switch (type)//只有两种密码，A和B
{
case RFIDFunction::KEY_A:
com[2] = 0xA3; // 设置为KEY_A
break;
case RFIDFunction::KEY_B:
com[2] = 0x5C; // 设置为KEY_B
break;
default:
com[2] = 0xA3; // 默认设置为KEY_A
break;
}
com[3] = 0x20; // 额外数据
memcpy(com + 4, &block, 1); // 将数据块添加到命令中
com[5] = 0x01;//蜂鸣器开 0x00不开
com[6] = 0x00;//保留
CheckSumOut(com, com[1]); // 计算校验和
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
//QByteArray AAA = readData.toHex(); // 转换为十六进制字符串
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x01) && (revData[1] == 0x16) && (revData[2] == com[2]) && (revData[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
data = QByteArray::fromHex(readData.mid(3,16));
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
RFIDFunction::ErrorCode RFIDFunction::setWorkMode(WorkMode mode, DataBlock block, UploadMode uploadMode)
{
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x03; // 命令头
com[1] = 0x08; // 数据长度
com[2] = 0xC1; // 工作模式
com[3] = 0x20; // 设备号数据
memcpy(com + 4, &mode, 1); // 将工作模式添加到命令中
switch (mode)
{
case RFIDFunction::Command_Mode:
com[5] = 0x00;
com[6] = 0x00;
break;
case RFIDFunction::Auto_Read_Card_Num_Mode:
com[5] = 0x00;
com[6] = uploadMode;
break;
case RFIDFunction::Auto_Read_Data_Mode:
case RFIDFunction::Auto_Read_Card_Num_Data_Mode:
default:
com[5] = block;
com[6] = uploadMode;
break;
}
CheckSumOut(com, com[1]); // 计算校验和
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
QByteArray AAA = readData.toHex(); // 转换为十六进制字符串
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x03) && (revData[1] == 0x08) && (revData[2] == com[2]) && (revData[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
RFIDFunction::ErrorCode RFIDFunction::getReaderAddress(QByteArray& psw)
{
unsigned char com[32] = { 0 }; // 命令数组
com[0] = 0x02; // 命令头
com[1] = 0x08; // 数据长度
com[2] = 0xB0; // 命令类型
com[3] = 0x00; // 额外数据
com[4] = 0x00; // 额外数据
com[5] = 0x00; // 额外数据
com[6] = 0x00; // 额外数据
CheckSumOut(com, com[1]); // 计算校验和
QByteArray AAA = QByteArray((char*)com, com[1]).toHex(); // 转换为十六进制字符串
if (m_SerialPort->isOpen()) // 检查串口是否打开
{
qint64 len = m_SerialPort->write(QByteArray((char*)com, com[1])); // 发送命令
if (len != com[1]) // 检查发送长度
{
return Send_Data_Error; // 发送错误
}
// 等待请求完成
sleepMs(200);
QByteArray readData = m_SerialPort->readAll(); // 读取返回数据
unsigned char revData[32] = { 0 }; // 存储返回数据
memcpy(revData, readData.data(), readData.size()); // 复制返回数据
if ((revData[0] == 0x02) && (revData[1] == 0x08) && (revData[2] == com[2])) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revData, revData[1]); //计算校验和
if (status)
{
if (revData[4] == 0x00) //写数据块成功
{
psw = QByteArray::fromHex(QByteArray(revData[5], 1));
return No_Error; // 返回无错误
}
}
else
{
return Received_Data_Check_Error; // 校验和错误
}
}
else
{
return Received_Data_Error; // 返回数据错误
}
}
return Serial_Error; // 串口错误
}
oldProject/rfid/rfidfunction.h
+171
View File
@@ -0,0 +1,171 @@
#pragma once
#include <QObject>
#include <QString>
#include <QByteArray>
#include "posix_qextserialport.h"
class RFIDFunction:public QObject
{
Q_OBJECT
public:
enum ControlBlock//加密块
{
Sector_0_Block_3 = 3,
Sector_1_Block_3 = 7,
Sector_2_Block_3 = 11,
Sector_3_Block_3 = 15,
Sector_4_Block_3 = 19,
Sector_5_Block_3 = 23,
Sector_6_Block_3 = 27,
Sector_7_Block_3 = 31,
Sector_8_Block_3 = 35,
Sector_9_Block_3 = 39,
Sector_10_Block_3 = 43,
Sector_11_Block_3 = 47,
Sector_12_Block_3 = 51,
Sector_13_Block_3 = 55,
Sector_14_Block_3 = 59,
Sector_15_Block_3 = 63
};
enum KeyType//密钥类型
{
KEY_A = 0, // 密钥A
KEY_B // 密钥B
};
enum DataBlock //数据块
{
Sector_0_Block_1 = 1,
Sector_0_Block_2 = 2,
Sector_1_Block_0 = 4,
Sector_1_Block_1 = 5,
Sector_1_Block_2 = 6,
Sector_2_Block_0 = 8,
Sector_2_Block_1 = 9,
Sector_2_Block_2 = 10,
Sector_3_Block_0 = 12,
Sector_3_Block_1 = 13,
Sector_3_Block_2 = 14,
Sector_4_Block_0 = 16,
Sector_4_Block_1 = 17,
Sector_4_Block_2 = 18,
Sector_5_Block_0 = 20,
Sector_5_Block_1 = 21,
Sector_5_Block_2 = 22,
Sector_6_Block_0 = 24,
Sector_6_Block_1 = 25,
Sector_6_Block_2 = 26,
Sector_7_Block_0 = 28,
Sector_7_Block_1 = 29,
Sector_7_Block_2 = 30,
Sector_8_Block_0 = 32,
Sector_8_Block_1 = 33,
Sector_8_Block_2 = 34,
Sector_9_Block_0 = 36,
Sector_9_Block_1 = 37,
Sector_9_Block_2 = 38,
Sector_10_Block_0 = 40,
Sector_10_Block_1 = 41,
Sector_10_Block_2 = 42,
Sector_11_Block_0 = 44,
Sector_11_Block_1 = 45,
Sector_11_Block_2 = 46,
Sector_12_Block_0 = 48,
Sector_12_Block_1 = 49,
Sector_12_Block_2 = 50,
Sector_13_Block_0 = 52,
Sector_13_Block_1 = 53,
Sector_13_Block_2 = 54,
Sector_14_Block_0 = 56,
Sector_14_Block_1 = 57,
Sector_14_Block_2 = 58,
Sector_15_Block_0 = 60,
Sector_15_Block_1 = 61,
Sector_15_Block_2 = 62
};
enum KeyFunction
{
KeyA_Same_KeyB = 0, // KEYA和KEYB相同
KeyB_Control_KeyA // KEYB控制KEYA
};
enum WorkMode //工作模式
{
Command_Mode = 0x01,//命令模式（关闭自动读卡），该模式会关闭自动读卡功能
Auto_Read_Card_Num_Mode = 0x02,//自动读卡号
Auto_Read_Data_Mode = 0x03,//自动读块数据，块号为要自动读的数据块编号
Auto_Read_Card_Num_Data_Mode = 0x04//自动读卡号与指定块数据，块号为要自动读的数据块编号
};
enum UploadMode//上传模式
{
Auto_Upload = 0x00,//读卡后主动发送数据，主动将读到的数据发送给上位机
Command_Upload = 0x01//读卡后被动发送数据，需要收到上位机获取数据的命令才将读到的数据发送给上位机
};
enum ErrorCode
{
No_Error = 0, // 无错误
Serial_Error, // 串口错误
Send_Data_Error, // 发送数据错误
Data_Is_Empty_Error, // 数据为空错误
Data_Size_More_Than_8192_Error, // 数据大小超过8192错误
Received_Data_Check_Error, // 接收数据校验错误
Received_Data_Error, // 接收数据错误
Data_Is_Illegal_Error // 数据非法错误
};
public:
RFIDFunction(QObject* parent); // 构造函数
~RFIDFunction(); // 析构函数
void CheckSumOut(unsigned char* buf, unsigned char len);
bool CheckSumIn(unsigned char* buf, unsigned char len);
ErrorCode initSerialPortAndOpen(const QString& portName, // 初始化串口并打开
BaudRateType baudRate = BAUD9600, // 波特率
DataBitsType setDataBits = DATA_8, // 数据位
StopBitsType stopBits = STOP_1, // 停止位
ParityType parity = PAR_NONE // 校验位
);
static const QByteArray createPassword(const QByteArray& info); // 创建密码
bool getSerialState(); // 获取串口状态
ErrorCode setOriginPassword(const QByteArray& psw); // 设置原始密码
ErrorCode setWriteAndReadPassword(const QByteArray& writePassword, const QByteArray& readPassword, KeyFunction keyFunc); // 设置读写密码
ErrorCode setEncryptedBlock(KeyType type, ControlBlock block); // 设置加密块
ErrorCode writeDataToBlock(KeyType type, DataBlock block, const QByteArray& data); // 写数据到块
ErrorCode readDataFromBlock(KeyType type, DataBlock block, QByteArray& data); // 从块读取数据
ErrorCode setWorkMode(WorkMode mode, DataBlock block = Sector_1_Block_2, UploadMode uploadMode = Auto_Upload);//设置工作模式
ErrorCode getReaderAddress(QByteArray& psw); // 获取读卡器地址
private:
bool m_SerialSate; // 串口状态
Posix_QextSerialPort *m_SerialPort;; // 串口对象
};
oldProject/rfid/rfidmanager.cpp
+980
View File
@@ -0,0 +1,980 @@
#include "rfidfunction.h"
#include "rfidmanager.h"
#include <LogInfo.h>
#include <QApplication>
#include <QElapsedTimer>
#include <QDebug>
#include <QMessageBox>
//#include "runtimectrl.h"
RFIDManager::RFIDManager()
{
comForRFID_init();
}
void RFIDManager::CheckSumOut(UCHAR *buf, UCHAR len)
{
UCHAR i;
UCHAR checksum;
checksum = 0;
if (len == 0)
return;
for (i = 0; i < (len - 1); i++)
{
checksum ^= buf[i];
}
buf[len - 1] = (UCHAR)~checksum;
}
bool RFIDManager::CheckSumIn(UCHAR *buf, UCHAR len)
{
UCHAR i;
UCHAR checksum;
checksum = 0;
if (len == 0) return false;
for (i = 0; i < (len - 1); i++)
{
checksum ^= buf[i];
}
if (buf[len - 1] == (UCHAR)~checksum)
{
return true;
}
return false;
}
void RFIDManager::MySleep(unsigned int msec, int expSize)
{
// QTime dieTime = QTime::currentTime().addMSecs(msec);
// while( QTime::currentTime() < dieTime ) {
// QCoreApplication::processEvents(QEventLoop::AllEvents, 100);
// }
// QByteArray recResponse;
RFIDReadData.clear();
QElapsedTimer elapsedTimer;
elapsedTimer.start();
while (!elapsedTimer.hasExpired(msec)) {
if (RFIDReadData.size() >= expSize) {
// recResponse = comForRFID->read(8);
break;
}
QCoreApplication::processEvents(QEventLoop::AllEvents, 10);
}
}
void RFIDManager::Hex2Str(const UCHAR *sSrc, UCHAR *sDest, int nSrcLen)
{
int i;
char szTmp[3];
for (i = 0; i < nSrcLen; i++)
{
sprintf(szTmp, "%02X", (unsigned char)sSrc[i]);
memcpy(&sDest[i * 2], szTmp, 2);
}
sDest[nSrcLen * 2] = '\0';
return;
}
void RFIDManager::HexStrToByte(const UCHAR *source, UCHAR *dest, int sourceLen)
{
short i;
unsigned char highByte, lowByte;
for (i = 0; i < sourceLen; i += 2)
{
highByte = toupper(source[i]);
lowByte = toupper(source[i + 1]);
if (highByte > 0x39)
highByte -= 0x37;
else
highByte -= 0x30;
if (lowByte > 0x39)
lowByte -= 0x37;
else
lowByte -= 0x30;
dest[i / 2] = (highByte << 4) | lowByte;
}
return;
}
void RFIDManager::comForRFID_init()
{
if (comForRFID) {
delete comForRFID;
comForRFID = nullptr;
}
checkCardIntervalTime = 0;
setICReaderModeFlag = false;
comForRFID = new QSerialPort();
#ifndef ARCH_X86
comForRFID->setPortName("/dev/ttyAS1");
#else
comForRFID->setPortName("/dev/ttyUSB0");
#endif
comForRFID->setBaudRate(9600);
comForRFID->setDataBits(QSerialPort::Data8);
comForRFID->setParity(QSerialPort::NoParity);
comForRFID->setStopBits(QSerialPort::OneStop);
comForRFID->setFlowControl(QSerialPort::NoFlowControl);
if (comForRFID->open(QIODevice::ReadWrite)) {
qDebug() << "RFID串口打开成功";
connect(comForRFID,SIGNAL(readyRead()),this,SLOT(slt_readRFIDData()));
} else {
qDebug() << "RFID串口打开失败：" << comForRFID->errorString();
delete comForRFID;
comForRFID = nullptr;
return;
}
initTimer();
}
int RFIDManager::comReadRFID_data()
{
UCHAR Cmd[23] = { 0x01, 0x17, 0xA4, 0x20, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
UCHAR revdata[100];
Cmd[1] = 0x08;
Cmd[2] = 0xA3;
Cmd[4] = 0x06; //读块6
CheckSumOut(Cmd, Cmd[1]);
QByteArray temp;
QByteArray recResponse;
temp.append((const char*)Cmd,Cmd[1]);
if(comForRFID->isOpen())
{
LogInfo::setRunStatusText(tr("readB6Req"));
comForRFID->clear(QSerialPort::Input);
comForRFID->write(temp);
}
else
{
qDebug()<<"read uart for RFID not open!";
}
MySleep(2000, 0x16);
int n = RFIDReadData.size();
if(n < 0x16)
{
LogInfo::setRunStatusText("RFID invalied data");
return 0;
}
n = std::max(0x16, n);
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
memcpy(revdata, recResponse.data(), n);
if ((revdata[0] == 0x01) && ((revdata[1] == 8)
|| (revdata[1] == 22)) && (revdata[1] == n)
&& (revdata[2] == 0xA3) && (revdata[3] == 0x20))//判断是否为读数据块返回的数据包
{
LogInfo::setRunStatusText(tr("readB6suc"));
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status)
{
if (revdata[4] == 0x00) //读数据块成功
{
UCHAR blockdata[16];
UCHAR temp[33];
for (int i = 0; i < 16; i++)
{
blockdata[i] = revdata[5 + i]; //复制数据到数组
}
Hex2Str(&blockdata[0], &temp[0], 16); // 数据块数据转换为字符
strRevdata = QString((const char*)temp);
// qDebug() << "读数据块成功，数据块6" << "数据为：" << temp << endl << endl;
return 1;
}
}
}
return 0;
}
QByteArray RFIDManager::buildMarkCardCommand(int block, int cardType)
{
UCHAR Cmd[23] = { 0x01, 0x17, 0xA4, 0x20, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
Cmd[1] = 0x17;
Cmd[2] = 0x5B;
Cmd[4] = block; //读块6
//save current date and time
QDateTime curDateTime = QDateTime::currentDateTime();
QString str = curDateTime.toString("yy:MM:dd:hh:mm:ss");
QList<QString> list = str.split(":");
for(int i = 0;i < list.size();i++){
Cmd[i+6] = list.at(i).toInt();
LogInfo::setRunStatusText(tr("Cmd[%1]: %2").arg(i+6).arg(Cmd[i+6]));
qDebug()<<"Cmd["<<i+6<<"]: "<<Cmd[i+6];
}
#ifdef ARCH_X86
// 可以让一张卡反复刷
if(cardType == 0) {
Cmd[6] = 0x10;
Cmd[7] = 0x0A;
}
else if(cardType == 1) {
Cmd[6] = 0x10;
Cmd[7] = 0x0B;
}
#endif
CheckSumOut(Cmd, Cmd[1]);
return QByteArray((char*)(const char*)Cmd,Cmd[1]);
}
bool RFIDManager::verifyWriteResponse(const QByteArray &recResponse, QString notice)
{
// 验证响应
if (recResponse.isEmpty()) {
//qDebug() << "RFIDReader response time: " << elapsedTimer.elapsed() << "ms";
return false;
}
int n = comForRFID->bytesAvailable();
if(n < 8) {
qDebug() << "读取数据失败, 数据长度不足8字节" << endl << endl;
return false;
}
UCHAR revdata[100];
if (n > sizeof(revdata)) return false;
memcpy(revdata, recResponse.constData(), n);
if ((revdata[0] == 0x01) && (revdata[1] == 8)
&& (revdata[1] == n) && (revdata[2] == 0x5B)
&& (revdata[3] == 0x20)) //判断是否为写数据返回的数据包
{
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status && revdata[4] == 0x00)
{
//写数据块成功
qDebug() << notice << "成功！" << endl << endl;
LogInfo::setRunStatusText(notice+"成功！");
return true;
}
}
qDebug() << notice << "失败!" << endl << endl;
LogInfo::setRunStatusText(notice+"失败!");
return false;
}
RFIDManager *RFIDManager::instance()
{
static RFIDManager* ins = nullptr;
if(ins == nullptr) {
ins = new RFIDManager();
}
return ins;
}
int RFIDManager::RFIDmarkCardUsedAsync(int type)
{
if (!comForRFID || !comForRFID->isOpen()) {
qDebug()<<"read uart for RFID not open!";
return 0;
}
// 构建命令（不硬编码块号） 读块6
QByteArray cmd = buildMarkCardCommand(0x06, type);
if (cmd.isEmpty()) {
qDebug() << "命令构建失败";
return 0;
}
// 临时断开信号，避免干扰
bool wasConnected = disconnect(comForRFID, &QSerialPort::readyRead,
this, &RFIDManager::slt_readRFIDData);
// 清空缓冲区
comForRFID->clear(QSerialPort::Input);
comForRFID->clear(QSerialPort::Output);
// 发送命令
qint64 written = comForRFID->write(cmd);
if (written != cmd.size()) {
qCritical() << "发送数据失败，发送字节数:" << written << "预期:" << cmd.size();
if (wasConnected) {
connect(comForRFID, &QSerialPort::readyRead,
this, &RFIDManager::slt_readRFIDData);
}
return 0;
}
QByteArray recResponse;
QElapsedTimer elapsedTimer;
elapsedTimer.start();
while (!elapsedTimer.hasExpired(2000)) {
if (comForRFID->bytesAvailable() >= 8) {
recResponse = comForRFID->read(8);
break;
}
QCoreApplication::processEvents(QEventLoop::AllEvents, 100);
}
// 恢复信号连接
if (wasConnected) {
connect(comForRFID, &QSerialPort::readyRead,
this, &RFIDManager::slt_readRFIDData);
}
bool res = verifyWriteResponse(recResponse, tr("写数据到数据块6"));
if (!res) {
qDebug() << "响应验证失败";
return 0;
}
qDebug() << "卡片标记成功，块:" << 06 << "耗时:" << elapsedTimer.elapsed() << "ms";
return 1;
}
void RFIDManager::initRFIDMoudle(unsigned int addr)
{
setICReaderModeFlag = true;
setRFIDReaderWorkMode();
setRFIDReaderKey(addr,1);
setICReaderModeFlag = false;
}
void RFIDManager::handleCheck(unsigned int addr)
{
// ink:100A2233445566778899AABBCCDDEEFF
if(!setICReaderModeFlag)
{
strRevdata ="";
receiveReadRFID_data();
if(strRevdata.length() > 3)
{
if((strRevdata.left(3) == QString::number(addr).left(3))
|| strRevdata.left(3) == "100")
{
if(strRevdata.at(3) == 'A')
{
bool flag = true;
if(!sysPara->status.flagOfNeedInkCard){
flag = false;
emit sig_showMsg(tr("不需要刷墨水卡!"));
}
else if(sysPara->status.statWarn & WARN_STATUS_INK_WARN){
flag = false;
emit sig_showMsg(tr("请先添加原厂墨水再刷墨水卡!"));
}
#ifdef __RFID_IND
if(flag){
sysPara->devOp->setRFIDReaderKey(ui->tabPrintSetting->dlgInputAddr->jd.addr,2);
sysPara->devOp->strRevdata ="";
if(sysPara->devOp->readIndBlock()){
if(sysPara->devOp->strRevdata.left(3) == QString::number(ui->tabPrintSetting->dlgInputAddr->jd.addr).left(3)){
if(sysPara->devOp->strRevdata.at(3) == 'C'){
if(sysPara->devOp->comWriteRFID_data(2) == 1)//把卡数据清零
{
// sysPara->RFIDPara.InkRFIDCnt = 0;
// sysPara->RFIDPara.PrintInkDots = 0;
// sysPara->saveRFIDPara();
// sysPara->devOp->checkCardIntervalTime = QDateTime::currentDateTime().toTime_t();
}
}
}
}
else{
flag = false;
LogInfo::setRunStatusText(tr("Read India Ink Block data failure."));
}
sysPara->devOp->setRFIDReaderKey(ui->tabPrintSetting->dlgInputAddr->jd.addr,1);
}
#endif
if(flag){
if(RFIDmarkCardUsedAsync(1) == 1)//把卡数据清零
{
sysPara->RFIDPara.InkRFIDCnt = 0;
sysPara->RFIDPara.PrintInkDots = 0;
sysPara->saveRFIDPara();
sysPara->para.RFIDInkWarn = false;
sysPara->para.inkWarnDate = 0;
sysPara->para.inkWarnTime = 0;
sysPara->status.flagOfInkMaxDot = false;
sysPara->status.flagOfNeedInkCard = false;
checkCardIntervalTime = QDateTime::currentDateTime().toTime_t();
emit sig_showMsg(tr("刷墨水卡成功!"));
sysPara->saveParaToFile();
}
}
}
else if(strRevdata.at(3) == 'B')
{
bool flag = true;
if(!sysPara->status.flagOfNeedSolventCard){
flag = false;
emit sig_showMsg(tr("不需要刷溶剂卡!"));
}
else if(sysPara->status.statWarn & WARN_STATUS_SOLV_WARN){
flag = false;
emit sig_showMsg(tr("请先添加原厂溶剂再刷溶剂卡!"));
}
#ifdef __RFID_IND
if(flag){
sysPara->devOp->setRFIDReaderKey(ui->tabPrintSetting->dlgInputAddr->jd.addr,2);
sysPara->devOp->strRevdata ="";
if(sysPara->devOp->readIndBlock()){
if(sysPara->devOp->strRevdata.left(3) == QString::number(ui->tabPrintSetting->dlgInputAddr->jd.addr).left(3)){
if(sysPara->devOp->strRevdata.at(3) == 'D'){
if(sysPara->devOp->comWriteRFID_data(2) == 1)//把卡数据清零
{
// sysPara->RFIDPara.InkRFIDCnt = 0;
// sysPara->RFIDPara.PrintInkDots = 0;
// sysPara->saveRFIDPara();
// sysPara->devOp->checkCardIntervalTime = QDateTime::currentDateTime().toTime_t();
}
}
}
}
else{
flag = false;
LogInfo::setRunStatusText(tr("Read India solvent Block data failure."));
}
sysPara->devOp->setRFIDReaderKey(ui->tabPrintSetting->dlgInputAddr->jd.addr,1);
}
#endif
if(flag){
if(RFIDmarkCardUsedAsync(1) == 1)//把卡数据清零
{
sysPara->RFIDPara.SOLVRFIDCnt = 0;
sysPara->RFIDPara.solventNumber = 0;
sysPara->saveRFIDPara();
sysPara->para.RFIDSolventWarn = 0;
sysPara->para.solventWarnDate = 0;
sysPara->para.solventWarnTime = 0;
sysPara->para.RFIDSolventWarnMixCnt = 0;
sysPara->status.flagOfSolventMaxNum = false;
sysPara->status.flagOfNeedSolventCard = false;
checkCardIntervalTime = QDateTime::currentDateTime().toTime_t();
emit sig_showMsg(tr("刷溶剂卡成功!"));
sysPara->saveParaToFile();
}
}
}
else
{
emit sig_showMsg(tr("MAC无效卡!"));
}
}
else
{
// LogInfo::setRunStatusText(tr("card data: %1").arg(sysPara->devOp->strRevdata));
QString str1 = QString::number(strRevdata.mid(0,2).toInt(0,16)).rightJustified(2,'0');
QString str2 =QString::number(strRevdata.mid(2,2).toInt(0,16)).rightJustified(2,'0');
QString str3 = QString::number(strRevdata.mid(4,2).toInt(0,16)).rightJustified(2,'0');
QString str4 = QString::number(strRevdata.mid(6,2).toInt(0,16)).rightJustified(2,'0');
QString str5 = QString::number(strRevdata.mid(8,2).toInt(0,16)).rightJustified(2,'0');
QString str6 =QString::number( strRevdata.mid(10,2).toInt(0,16)).rightJustified(2,'0');
QString strDateTime = str1 + "-" + str2 + "-" + str3 + " " + str4 + ":" + str5 + ":" + str6;
QString strShow = tr("无效卡,这张卡已经在%1时使用过").arg(strDateTime);
emit sig_showMsg(strShow);
}
}
}
}
void RFIDManager::bindSysPara(SysPara *sysPara)
{
this->sysPara = sysPara;
}
int RFIDManager::setRFIDCarKey()
{
UCHAR revdata[100];
UCHAR Cmd[8] ;
Cmd[0] = 0x01; //命令格式请核对协议手册充值章节
Cmd[1] = 0x08;
Cmd[2] = 0xA5; //加密扇区
Cmd[3] = 0x20;
Cmd[4] = 0x07; //块7
Cmd[5] = 0x01;
Cmd[6] = 0x00;
Cmd[7] = 0x00;
CheckSumOut(Cmd, Cmd[1]);
QByteArray temp;
QByteArray recResponse;
temp.append((const char*)Cmd,Cmd[1]);
if(comForRFID->isOpen())
{
comForRFID->clear(QSerialPort::Input);
comForRFID->write(temp);
}
else
{
qDebug()<<"read uart for RFID not open!";
}
MySleep(2000);
int n = RFIDReadData.size();
if(n>2)
{
recResponse = RFIDReadData;
RFIDReadData.clear();
QString str;
str.sprintf("%d - %d - %d", recResponse.at(0),recResponse.at(1),recResponse.at(2));
qDebug()<<"加密IC卡: "<<str;
}
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
memcpy(revdata, recResponse.data(), n);
if ((revdata[0] == 0x01) &&( revdata[1] == 8 )&& (revdata[1] == n) && (revdata[2] == 0xA5) && (revdata[3] == 0x20)) //判断是否为设置地址返回的数据包
{
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status)
{
if (revdata[4] == 0x00) //成功
{
qDebug() << "加密IC卡成功!" << endl << endl;
}
else
{
qDebug() << "加密IC卡失败!" << endl << endl;
}
}
}
else
{
qDebug() << "加密IC卡失败2!" << endl << endl;
}
}
int RFIDManager::setRFIDReaderKey(int mac,int type)
{
if (!comForRFID) return;
if(mac == 0) mac = 100;
QString strMac1 = QString::number(mac).mid(0,3);
strMac1 = "Vernon" + strMac1 + "Bach";
strMac1 = strMac1.leftJustified(16,'6');
QString strMac2 =QString::number(mac).mid(0,3);
strMac2 = "VernonBach" + strMac2;
strMac2 = strMac2.leftJustified(16,'6');
QByteArray password = "";
if(type == 1)
password = RFIDFunction::createPassword((const QByteArray)strMac1.toUtf8());
else if(type == 2)
password = RFIDFunction::createPassword((const QByteArray)strMac2.toUtf8());
const QByteArray pw = password.mid(12,12);
UCHAR revdata[100];
UCHAR Cmd[21] ;
Cmd[0] = 0x03; //命令格式请核对协议手册充值章节
Cmd[1] = 0x15;
Cmd[2] = 0xC3; //设置密钥
Cmd[3] = 0x20;
Cmd[4] = 0x99;
Cmd[5] = 0x88;
Cmd[6] = 0x77;
Cmd[7] = 0x66;
Cmd[8] = 0x55;
Cmd[9] = 0x44;
Cmd[10] = 0xFF;
Cmd[11] = 0x07;
Cmd[12] = 0x80;
Cmd[13] = 0x69;
Cmd[14] = 0xAA;
Cmd[15] = 0xBB;
Cmd[16] = 0xCC;
Cmd[17] = 0xDD;
Cmd[18] = 0xEE;
Cmd[19] = 0xFF;
Cmd[20] = 0x1B;
#ifndef __RFID_OLD
bool ok;
for(int i = 0;i<6;i++){
int pwInt = Cmd[i+14] = pw.mid(i*2,2).toInt(&ok,16);
if (!ok) {
qDebug() << "Error: Invalid hex value: "<<pw.mid(i*2,2);
return -1;
}
if(pwInt < 256)
Cmd[i+4] = Cmd[i+14] = pwInt;
else{
qDebug() << "Error: Invalid pwInt value: "<<pwInt;
return -1;
}
}
#endif
CheckSumOut(Cmd, Cmd[1]);
QByteArray temp;
QByteArray recResponse;
temp.append((const char*)Cmd,Cmd[1]);
if(comForRFID->isOpen())
{
comForRFID->clear(QSerialPort::Input);
RFIDReadData.clear();
comForRFID->write(temp);
}
else
{
qDebug()<<"read uart for RFID not open!";
}
MySleep(2000);
int n = RFIDReadData.size();
if(n < 8) {
LogInfo::setRunStatusText(tr("设置读写器密码失败!"));
return 0;
}
n = std::max(8, n);
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
memcpy(revdata, recResponse.data(), n);
if ((revdata[0] == 0x03) &&( revdata[1] == 8 )&& (revdata[1] == n) && (revdata[2] == 0xC3) && (revdata[3] == 0x20)) //判断是否为设置地址返回的数据包
{
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status)
{
if (revdata[4] == 0x00) //成功
{
qDebug() << "设置读写器密码成功!" << endl << endl;
LogInfo::setRunStatusText(tr("设置读写器密码成功!"));
}
else
{
qDebug() << "设置读写器密码失败!" << endl << endl;
}
}
}
else
{
qDebug() << "设置读写器密码失败!" << endl << endl;
}
return 0;
}
int RFIDManager::setRFIDReaderOriginalKey(void)
{
UCHAR revdata[100];
UCHAR Cmd[11] ;
Cmd[0] = 0x03; //命令格式请核对协议手册充值章节
Cmd[1] = 0x0B;
Cmd[2] = 0xC4; //设置密钥
Cmd[3] = 0x20;
Cmd[4] = 0xFF;
Cmd[5] = 0xFF;
Cmd[6] = 0xFF;
Cmd[7] = 0xFF;
Cmd[8] = 0xFF;
Cmd[9] = 0xFF;
Cmd[10] = 0x00;
CheckSumOut(Cmd, Cmd[1]);
QByteArray temp;
QByteArray recResponse;
temp.append((const char*)Cmd,Cmd[1]);
if(comForRFID->isOpen())
{
comForRFID->clear(QSerialPort::Input);
comForRFID->write(temp);
}
else
{
qDebug()<<"read uart for RFID not open!";
}
MySleep(2000);
int n = RFIDReadData.size();
if(n < 8) {
LogInfo::setRunStatusText(tr("设置读写器原始密码失败!"));
return 0;
}
n = std::max(8, n);
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
memcpy(revdata, recResponse.data(), n);
if ((revdata[0] == 0x03) &&( revdata[1] == 8 )&& (revdata[1] == n) && (revdata[2] == 0xC4) && (revdata[3] == 0x20)) //判断是否为设置地址返回的数据包
{
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status)
{
if (revdata[4] == 0x00) //成功
{
qDebug() << "设置读写器原始密码成功!" << endl << endl;
}
else
{
qDebug() << "设置读写器原始密码失败!" << endl << endl;
}
}
}
else
{
qDebug() << "设置读写器原始密码失败!" << endl << endl;
}
}
int RFIDManager::setRFIDReaderWorkMode(void)
{
if (!comForRFID) return;
UCHAR revdata[100];
UCHAR Cmd[8] ;
Cmd[0] = 0x03; //命令格式请核对协议手册充值章节
Cmd[1] = 0x08;
Cmd[2] = 0xC1; //设置工作模式
Cmd[3] = 0x20;
Cmd[4] = 0x03;
Cmd[5] = 0x06; //读块6
Cmd[6] = 0x00; //主动发送数据
Cmd[7] = 0x00;
CheckSumOut(Cmd, Cmd[1]);
QByteArray temp;
QByteArray recResponse;
temp.append((const char*)Cmd,Cmd[1]);
if(comForRFID->isOpen())
{
comForRFID->clear(QSerialPort::Input);
comForRFID->write(temp);
}
else
{
qDebug()<<"read uart for RFID not open!";
}
// 延时200毫秒等待读写器返回数据，延时太小可能无法接收完整的数据包
MySleep(2000);
int n = RFIDReadData.size();
if(n < 8) {
LogInfo::setRunStatusText(tr("设置读写器工作模式失败!"));
return 0;
}
n = std::max(8, n);
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
if(n>2)
{
recResponse = RFIDReadData;
RFIDReadData.clear();
QString str;
str.sprintf("%d - %d - %d", recResponse.at(0),recResponse.at(1),recResponse.at(2));
qDebug()<<"设置读写器工作模式: "<<str;
}
// bool res = verifyWriteResponse(recResponse, tr("设置读写器工作模式"));
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
memcpy(revdata, recResponse.data(), n);
if ((revdata[0] == 0x03) &&( revdata[1] == 8 )
&& (revdata[1] == n) && (revdata[2] == 0xC1)
&& (revdata[3] == 0x20)) //判断是否为设置地址返回的数据包
{
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status && revdata[4] == 0x00)
{
qDebug() << "设置读写器工作模式成功!" << endl << endl;
LogInfo::setRunStatusText(tr("设置读写器工作模式成功!"));
return 1;
}
}
qDebug() << "设置读写器工作模式失败!" << endl << endl;
return 0;
}
int RFIDManager::receiveReadRFID_data(void)
{
UCHAR revdata[100];
QByteArray recResponse;
int n = RFIDReadData.size();
if(n>0)
{
recResponse = RFIDReadData;
RFIDReadData.clear();
// showData(recResponse);
}
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
memcpy(revdata, recResponse.data(), n);
if ((revdata[0] == 0x04) && ((revdata[1] == 8)
|| (revdata[1] == 22)) && (revdata[1] == n)
&& (revdata[2] == 0x03) && (revdata[3] == 0x20))//判断是否为读数据块返回的数据包
{
bool status = CheckSumIn(revdata, revdata[1]); //计算校验和
if (status)
{
if (revdata[4] == 0x00) //读数据块成功
{
UCHAR blockdata[16];
UCHAR temp[33];
for (int i = 0; i < 16; i++)
{
blockdata[i] = revdata[5 + i]; //复制数据到数组
}
Hex2Str(&blockdata[0], &temp[0], 16); // 数据块数据转换为字符
strRevdata = QString((const char*)temp);
return 1;
}
else
{
return 0;
}
}
}
return 0;
}
int RFIDManager::queryReadRFID_address(void)
{
if (!comForRFID) return;
UCHAR Cmd[8] ;
Cmd[0] = 0x02; //命令格式请核对协议手册充值章节
Cmd[1] = 0x08;
Cmd[2] = 0xB0; //查询读写器地址
Cmd[3] = 0x00;
Cmd[4] = 0x00;
Cmd[5] = 0x00;
Cmd[6] = 0x00;
Cmd[7] = 0x00;
CheckSumOut(Cmd, Cmd[1]);
QByteArray temp;
UCHAR revdata[100];
temp.append((const char*)Cmd,Cmd[1]);
if(comForRFID->isOpen())
{
comForRFID->clear(QSerialPort::Input);
RFIDReadData.clear();
comForRFID->write(temp);
}
else
{
qDebug()<<"read uart for RFID not open!";
}
MySleep(2000);
int n = RFIDReadData.size();
if(n < 8) {
LogInfo::setRunStatusText(tr("查询读写器地址失败"));
return 1;
}
n = std::max(8, n);
if (n > sizeof(revdata)) {
return 0; // 防止后面拷贝越界
}
if (n > sizeof(revdata)) return;
memcpy(revdata, RFIDReadData.data(), n);
if(n>0)
{
// showData(RFIDReadData);
if(CheckSumIn(revdata, revdata[1]) == false){
RFIDReadData.clear();
return 0;
}
if(revdata[0] == 0x02 && revdata[1] == 0x08
&& revdata[2] == 0xB0 && revdata[4] == 0x00){
RFIDReadData.clear();
return 1;
}
}
else //没有收到数据
return 2;
}
void RFIDManager::initTimer()
{
if (RFIDTimer == nullptr) {
RFIDTimer = new QTimer(this);
connect(RFIDTimer, &QTimer::timeout,
this, &RFIDManager::slt_timerHandle);
RFIDTimer->start(10 * 1000);
}
}
//bool RFIDManager::cardTouchConfirm(QString msgTxt, QString variableMsgTxt)
//{
// QMessageBox box(QMessageBox::Warning, tr("警告"),
// msgTxt, QMessageBox::Ok | QMessageBox::Cancel);
// int rfidCountDown = sysPara->para.rfidCountDown;
// QTimer msgTimer;
// QString boxTxt = variableMsgTxt;
// connect(&msgTimer, &QTimer::timeout, [this, &box, &rfidCountDown, boxTxt]() {
// box.setText(boxTxt.arg(rfidCountDown));
// box.update();
// rfidCountDown--;
// if(rfidCountDown == 0) {
// box.accept();
// }
// });
// if(sysPara->para.rfidCountDown > 0) {
// box.setText(boxTxt.arg(sysPara->para.rfidCountDown));
// msgTimer.start(1000);
// }
// box.exec();
// return box.result() == QMessageBox::Ok || box.result() == QMessageBox::Accepted;
//}
void RFIDManager::slt_readRFIDData()
{
QMutexLocker locker(&m_rfidMutex);
RFIDReadData.append(comForRFID->readAll());
}
void RFIDManager::slt_timerHandle()
{
static int faultyNum = 0;
static uint noticeICReaderErrorTime = QDateTime::currentDateTime().toTime_t();
if((QDateTime::currentDateTime().toTime_t() - noticeICReaderErrorTime > 7200
|| QDateTime::currentDateTime().toTime_t() == noticeICReaderErrorTime)
|| (faultyNum > 0 && faultyNum < 10))
{
noticeICReaderErrorTime = QDateTime::currentDateTime().toTime_t();
if(queryReadRFID_address() == 2)
{
faultyNum++;
if(faultyNum >= 10){
emit sig_showMsg(tr("13.读卡器故障!"));
qDebug()<<"读卡器故障";
}
}
else
faultyNum = 0;
}
}
oldProject/rfid/rfidmanager.h
+85
View File
@@ -0,0 +1,85 @@
#ifndef RFIDMANAGER_H
#define RFIDMANAGER_H
#include "myinclude.h"
#include <QSerialPort>
#include <QObject>
#include <QTimer>
#include <QMutex>
#include "SysPara.h"
typedef unsigned char UCHAR;
class RFIDManager : public QObject
{
Q_OBJECT
public:
static RFIDManager* instance();
public:
/**
* @brief 向卡片写入当前日期时间，标识该卡片已被使用
*/
int RFIDmarkCardUsedAsync(int type);
// InkJetPrinter定时器timerHandler触发，检查刷卡状态
// 初始化刷卡模块
void initRFIDMoudle(unsigned int addr);
// 300ms检查处理
void handleCheck(unsigned int addr);
void bindSysPara(SysPara *sysPara);
private:
RFIDManager();
// 工具类函数
void CheckSumOut(UCHAR *buf, UCHAR len);
bool CheckSumIn(UCHAR *buf, UCHAR len);
void MySleep(unsigned int msec, int expSize = 8);
void Hex2Str(const UCHAR *sSrc, UCHAR *sDest, int nSrcLen);
void HexStrToByte(const UCHAR* source, UCHAR* dest, int sourceLen);
// 串口
QSerialPort *comForRFID = nullptr;
void comForRFID_init();
int comReadRFID_data();
QByteArray buildMarkCardCommand(int block, int cardType);
bool verifyWriteResponse(const QByteArray& response, QString notice);
int setRFIDCarKey(void);
int setRFIDReaderKey(int,int);
int setRFIDReaderOriginalKey(void);
int setRFIDReaderWorkMode(void);
int receiveReadRFID_data(void);
int queryReadRFID_address(void);
QMutex m_rfidMutex;
QByteArray RFIDReadData;
QString strRevdata;
bool setICReaderModeFlag;
uint checkCardIntervalTime;
QTimer* RFIDTimer = nullptr;
void initTimer();
// bool cardTouchConfirm(QString msgTxt, QString variableMsgTxt);
// vx5的系统参数没有实现单例
SysPara *sysPara = nullptr;
signals:
void sig_showMsg(QString msg);
void sig_maintenanceShow();
private slots:
//接收刷卡数据槽函数
void slt_readRFIDData();
//超时处理槽函数
void slt_timerHandle();
};
#endif // RFIDMANAGER_H
oldProject/rfid/sm3.cpp
+310
View File
@@ -0,0 +1,310 @@
#include "sm3.h"
#include <string.h>
#include <stdio.h>
#ifndef GET_ULONG_BE
#define GET_ULONG_BE(n,b,i) \
{ \
(n) = ( (uint32_t) (b)[(i) ] << 24 ) \
| ( (uint32_t) (b)[(i) + 1] << 16 ) \
| ( (uint32_t) (b)[(i) + 2] << 8 ) \
| ( (uint32_t) (b)[(i) + 3] ); \
}
#endif
#ifndef PUT_ULONG_BE
#define PUT_ULONG_BE(n,b,i) \
{ \
(b)[(i) ] = (unsigned char) ( (n) >> 24 ); \
(b)[(i) + 1] = (unsigned char) ( (n) >> 16 ); \
(b)[(i) + 2] = (unsigned char) ( (n) >> 8 ); \
(b)[(i) + 3] = (unsigned char) ( (n) ); \
}
#endif
void SM3::sm3_starts( sm3_context *ctx )
{
ctx->total[0] = 0;
ctx->total[1] = 0;
ctx->state[0] = 0x7380166F;
ctx->state[1] = 0x4914B2B9;
ctx->state[2] = 0x172442D7;
ctx->state[3] = 0xDA8A0600;
ctx->state[4] = 0xA96F30BC;
ctx->state[5] = 0x163138AA;
ctx->state[6] = 0xE38DEE4D;
ctx->state[7] = 0xB0FB0E4E;
}
static void sm3_process( sm3_context *ctx, unsigned char data[64] )
{
uint32_t SS1, SS2, TT1, TT2, W[68],W1[64];
uint32_t A, B, C, D, E, F, G, H;
uint32_t T[64];
uint32_t Temp1,Temp2,Temp3,Temp4,Temp5;
int j;
for(j = 0; j < 16; j++)
T[j] = 0x79CC4519;
for(j =16; j < 64; j++)
T[j] = 0x7A879D8A;
GET_ULONG_BE( W[ 0], data, 0 );
GET_ULONG_BE( W[ 1], data, 4 );
GET_ULONG_BE( W[ 2], data, 8 );
GET_ULONG_BE( W[ 3], data, 12 );
GET_ULONG_BE( W[ 4], data, 16 );
GET_ULONG_BE( W[ 5], data, 20 );
GET_ULONG_BE( W[ 6], data, 24 );
GET_ULONG_BE( W[ 7], data, 28 );
GET_ULONG_BE( W[ 8], data, 32 );
GET_ULONG_BE( W[ 9], data, 36 );
GET_ULONG_BE( W[10], data, 40 );
GET_ULONG_BE( W[11], data, 44 );
GET_ULONG_BE( W[12], data, 48 );
GET_ULONG_BE( W[13], data, 52 );
GET_ULONG_BE( W[14], data, 56 );
GET_ULONG_BE( W[15], data, 60 );
#define FF0(x,y,z) ( (x) ^ (y) ^ (z))
#define FF1(x,y,z) (((x) & (y)) | ( (x) & (z)) | ( (y) & (z)))
#define GG0(x,y,z) ( (x) ^ (y) ^ (z))
#define GG1(x,y,z) (((x) & (y)) | ( (~(x)) & (z)) )
#define SHL(x,n) (((x) & 0xFFFFFFFF) << n)
#define ROTL(x,n) (SHL((x),n) | ((x) >> (32 - n)))
#define P0(x) ((x) ^ ROTL((x),9) ^ ROTL((x),17))
#define P1(x) ((x) ^ ROTL((x),15) ^ ROTL((x),23))
for(j = 16; j < 68; j++ )
{
//W[j] = P1( W[j-16] ^ W[j-9] ^ ROTL(W[j-3],15)) ^ ROTL(W[j - 13],7 ) ^ W[j-6];
//Why thd release's result is different with the debug's ?
//Below is okay. Interesting, Perhaps VC6 has a bug of Optimizaiton.
Temp1 = W[j-16] ^ W[j-9];
Temp2 = ROTL(W[j-3],15);
Temp3 = Temp1 ^ Temp2;
Temp4 = P1(Temp3);
Temp5 = ROTL(W[j - 13],7 ) ^ W[j-6];
W[j] = Temp4 ^ Temp5;
}
for(j = 0; j < 64; j++)
{
W1[j] = W[j] ^ W[j+4];
}
A = ctx->state[0];
B = ctx->state[1];
C = ctx->state[2];
D = ctx->state[3];
E = ctx->state[4];
F = ctx->state[5];
G = ctx->state[6];
H = ctx->state[7];
for(j =0; j < 16; j++)
{
SS1 = ROTL((ROTL(A,12) + E + ROTL(T[j],j)), 7);
SS2 = SS1 ^ ROTL(A,12);
TT1 = FF0(A,B,C) + D + SS2 + W1[j];
TT2 = GG0(E,F,G) + H + SS1 + W[j];
D = C;
C = ROTL(B,9);
B = A;
A = TT1;
H = G;
G = ROTL(F,19);
F = E;
E = P0(TT2);
}
for(j =16; j < 64; j++)
{
SS1 = ROTL((ROTL(A,12) + E + ROTL(T[j],j)), 7);
SS2 = SS1 ^ ROTL(A,12);
TT1 = FF1(A,B,C) + D + SS2 + W1[j];
TT2 = GG1(E,F,G) + H + SS1 + W[j];
D = C;
C = ROTL(B,9);
B = A;
A = TT1;
H = G;
G = ROTL(F,19);
F = E;
E = P0(TT2);
}
ctx->state[0] ^= A;
ctx->state[1] ^= B;
ctx->state[2] ^= C;
ctx->state[3] ^= D;
ctx->state[4] ^= E;
ctx->state[5] ^= F;
ctx->state[6] ^= G;
ctx->state[7] ^= H;
}
void SM3::sm3_update( sm3_context *ctx, unsigned char *input, int ilen )
{
int fill;
uint32_t left;
if( ilen <= 0 )
return;
left = ctx->total[0] & 0x3F;
fill = 64 - left;
ctx->total[0] += ilen;
ctx->total[0] &= 0xFFFFFFFF;
if( ctx->total[0] < (uint32_t) ilen )
ctx->total[1]++;
if( left && ilen >= fill )
{
memcpy( (void *) (ctx->buffer + left),
(void *) input, fill );
sm3_process( ctx, ctx->buffer );
input += fill;
ilen -= fill;
left = 0;
}
while( ilen >= 64 )
{
sm3_process( ctx, input );
input += 64;
ilen -= 64;
}
if( ilen > 0 )
{
memcpy( (void *) (ctx->buffer + left),
(void *) input, ilen );
}
}
static const unsigned char sm3_padding[64] =
{
0x80, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
};
void SM3::sm3_finish( sm3_context *ctx, unsigned char output[32] )
{
uint32_t last, padn;
uint32_t high, low;
unsigned char msglen[8];
high = ( ctx->total[0] >> 29 )
| ( ctx->total[1] << 3 );
low = ( ctx->total[0] << 3 );
PUT_ULONG_BE( high, msglen, 0 );
PUT_ULONG_BE( low, msglen, 4 );
last = ctx->total[0] & 0x3F;
padn = ( last < 56 ) ? ( 56 - last ) : ( 120 - last );
sm3_update( ctx, (unsigned char *) sm3_padding, padn );
sm3_update( ctx, msglen, 8 );
PUT_ULONG_BE( ctx->state[0], output, 0 );
PUT_ULONG_BE( ctx->state[1], output, 4 );
PUT_ULONG_BE( ctx->state[2], output, 8 );
PUT_ULONG_BE( ctx->state[3], output, 12 );
PUT_ULONG_BE( ctx->state[4], output, 16 );
PUT_ULONG_BE( ctx->state[5], output, 20 );
PUT_ULONG_BE( ctx->state[6], output, 24 );
PUT_ULONG_BE( ctx->state[7], output, 28 );
}
void SM3::sm3Hash( unsigned char *input, int ilen,
unsigned char output[32] )
{
sm3_context ctx;
sm3_starts( &ctx );
sm3_update( &ctx, input, ilen );
sm3_finish( &ctx, output );
memset( &ctx, 0, sizeof( sm3_context ) );
}
void SM3::sm3_hmac_starts( sm3_context *ctx, unsigned char *key, int keylen )
{
int i;
unsigned char sum[32];
if( keylen > 64 )
{
sm3Hash( key, keylen, sum );
keylen = 32;
key = sum;
}
memset( ctx->ipad, 0x36, 64 );
memset( ctx->opad, 0x5C, 64 );
for( i = 0; i < keylen; i++ )
{
ctx->ipad[i] = (unsigned char)( ctx->ipad[i] ^ key[i] );
ctx->opad[i] = (unsigned char)( ctx->opad[i] ^ key[i] );
}
sm3_starts( ctx);
sm3_update( ctx, ctx->ipad, 64 );
memset( sum, 0, sizeof( sum ) );
}
void SM3::sm3_hmac_update( sm3_context *ctx, unsigned char *input, int ilen )
{
sm3_update( ctx, input, ilen );
}
void SM3::sm3_hmac_finish( sm3_context *ctx, unsigned char output[32] )
{
int hlen;
unsigned char tmpbuf[32];
hlen = 32;
sm3_finish( ctx, tmpbuf );
sm3_starts( ctx );
sm3_update( ctx, ctx->opad, 64 );
sm3_update( ctx, tmpbuf, hlen );
sm3_finish( ctx, output );
memset( tmpbuf, 0, sizeof( tmpbuf ) );
}
void SM3::sm3_hmac( unsigned char *key, int keylen,
unsigned char *input, int ilen,
unsigned char output[32] )
{
sm3_context ctx;
sm3_hmac_starts( &ctx, key, keylen);
sm3_hmac_update( &ctx, input, ilen );
sm3_hmac_finish( &ctx, output );
memset( &ctx, 0, sizeof( sm3_context ) );
}
oldProject/rfid/sm3.h
+37
View File
@@ -0,0 +1,37 @@
#ifndef SM3_H
#define SM3_H
#include <stdio.h>
#include <stdint.h>
typedef struct
{
uint32_t total[2];
uint32_t state[8];
unsigned char buffer[64];
unsigned char ipad[64];
unsigned char opad[64];
}sm3_context;
class SM3
{
public:
static void sm3_starts(sm3_context* ctx);
static void sm3_update(sm3_context* ctx, unsigned char* input, int ilen);
static void sm3_finish(sm3_context* ctx, unsigned char output[32]);
static void sm3Hash(unsigned char* input, int ilen,
unsigned char output[32]);
static void sm3_hmac_starts(sm3_context* ctx, unsigned char* key, int keylen);
static void sm3_hmac_update(sm3_context* ctx, unsigned char* input, int ilen);
static void sm3_hmac_finish(sm3_context* ctx, unsigned char output[32]);
static void sm3_hmac(unsigned char* key, int keylen,
unsigned char* input, int ilen,
unsigned char output[32]);
};
#endif /* sm3.h */
oldProject/rfid/sm4.cpp
+231
View File
@@ -0,0 +1,231 @@
#include "sm4.h"
#include <string.h>
#include <stdio.h>
#ifndef GET_ULONG_BE
#define GET_ULONG_BE(n,b,i) \
{ \
(n) = ( (unsigned long) (b)[(i) ] << 24 ) \
| ( (unsigned long) (b)[(i) + 1] << 16 ) \
| ( (unsigned long) (b)[(i) + 2] << 8 ) \
| ( (unsigned long) (b)[(i) + 3] ); \
}
#endif
#ifndef PUT_ULONG_BE
#define PUT_ULONG_BE(n,b,i) \
{ \
(b)[(i) ] = (unsigned char) ( (n) >> 24 ); \
(b)[(i) + 1] = (unsigned char) ( (n) >> 16 ); \
(b)[(i) + 2] = (unsigned char) ( (n) >> 8 ); \
(b)[(i) + 3] = (unsigned char) ( (n) ); \
}
#endif
#define SHL(x,n) (((x) & 0xFFFFFFFF) << n)
#define ROTL(x,n) (SHL((x),n) | ((x) >> (32 - n)))
#define SWAP(a,b) { unsigned long t = a; a = b; b = t; t = 0; }
static const unsigned char SboxTable[16][16] =
{
{0xd6,0x90,0xe9,0xfe,0xcc,0xe1,0x3d,0xb7,0x16,0xb6,0x14,0xc2,0x28,0xfb,0x2c,0x05},
{0x2b,0x67,0x9a,0x76,0x2a,0xbe,0x04,0xc3,0xaa,0x44,0x13,0x26,0x49,0x86,0x06,0x99},
{0x9c,0x42,0x50,0xf4,0x91,0xef,0x98,0x7a,0x33,0x54,0x0b,0x43,0xed,0xcf,0xac,0x62},
{0xe4,0xb3,0x1c,0xa9,0xc9,0x08,0xe8,0x95,0x80,0xdf,0x94,0xfa,0x75,0x8f,0x3f,0xa6},
{0x47,0x07,0xa7,0xfc,0xf3,0x73,0x17,0xba,0x83,0x59,0x3c,0x19,0xe6,0x85,0x4f,0xa8},
{0x68,0x6b,0x81,0xb2,0x71,0x64,0xda,0x8b,0xf8,0xeb,0x0f,0x4b,0x70,0x56,0x9d,0x35},
{0x1e,0x24,0x0e,0x5e,0x63,0x58,0xd1,0xa2,0x25,0x22,0x7c,0x3b,0x01,0x21,0x78,0x87},
{0xd4,0x00,0x46,0x57,0x9f,0xd3,0x27,0x52,0x4c,0x36,0x02,0xe7,0xa0,0xc4,0xc8,0x9e},
{0xea,0xbf,0x8a,0xd2,0x40,0xc7,0x38,0xb5,0xa3,0xf7,0xf2,0xce,0xf9,0x61,0x15,0xa1},
{0xe0,0xae,0x5d,0xa4,0x9b,0x34,0x1a,0x55,0xad,0x93,0x32,0x30,0xf5,0x8c,0xb1,0xe3},
{0x1d,0xf6,0xe2,0x2e,0x82,0x66,0xca,0x60,0xc0,0x29,0x23,0xab,0x0d,0x53,0x4e,0x6f},
{0xd5,0xdb,0x37,0x45,0xde,0xfd,0x8e,0x2f,0x03,0xff,0x6a,0x72,0x6d,0x6c,0x5b,0x51},
{0x8d,0x1b,0xaf,0x92,0xbb,0xdd,0xbc,0x7f,0x11,0xd9,0x5c,0x41,0x1f,0x10,0x5a,0xd8},
{0x0a,0xc1,0x31,0x88,0xa5,0xcd,0x7b,0xbd,0x2d,0x74,0xd0,0x12,0xb8,0xe5,0xb4,0xb0},
{0x89,0x69,0x97,0x4a,0x0c,0x96,0x77,0x7e,0x65,0xb9,0xf1,0x09,0xc5,0x6e,0xc6,0x84},
{0x18,0xf0,0x7d,0xec,0x3a,0xdc,0x4d,0x20,0x79,0xee,0x5f,0x3e,0xd7,0xcb,0x39,0x48}
};
static const unsigned long FK[4] = {0xa3b1bac6,0x56aa3350,0x677d9197,0xb27022dc};
static const unsigned long CK[32] =
{
0x00070e15,0x1c232a31,0x383f464d,0x545b6269,
0x70777e85,0x8c939aa1,0xa8afb6bd,0xc4cbd2d9,
0xe0e7eef5,0xfc030a11,0x181f262d,0x343b4249,
0x50575e65,0x6c737a81,0x888f969d,0xa4abb2b9,
0xc0c7ced5,0xdce3eaf1,0xf8ff060d,0x141b2229,
0x30373e45,0x4c535a61,0x686f767d,0x848b9299,
0xa0a7aeb5,0xbcc3cad1,0xd8dfe6ed,0xf4fb0209,
0x10171e25,0x2c333a41,0x484f565d,0x646b7279
};
static unsigned char sm4Sbox(unsigned char inch)
{
unsigned char *pTable = (unsigned char *)SboxTable;
unsigned char retVal = (unsigned char)(pTable[inch]);
return retVal;
}
static unsigned long sm4Lt(unsigned long ka)
{
unsigned long bb = 0;
unsigned long c = 0;
unsigned char a[4];
unsigned char b[4];
PUT_ULONG_BE(ka,a,0)
b[0] = sm4Sbox(a[0]);
b[1] = sm4Sbox(a[1]);
b[2] = sm4Sbox(a[2]);
b[3] = sm4Sbox(a[3]);
GET_ULONG_BE(bb,b,0)
c =bb^(ROTL(bb, 2))^(ROTL(bb, 10))^(ROTL(bb, 18))^(ROTL(bb, 24));
return c;
}
static unsigned long sm4F(unsigned long x0, unsigned long x1, unsigned long x2, unsigned long x3, unsigned long rk)
{
return (x0^sm4Lt(x1^x2^x3^rk));
}
static unsigned long sm4CalciRK(unsigned long ka)
{
unsigned long bb = 0;
unsigned long rk = 0;
unsigned char a[4];
unsigned char b[4];
PUT_ULONG_BE(ka,a,0)
b[0] = sm4Sbox(a[0]);
b[1] = sm4Sbox(a[1]);
b[2] = sm4Sbox(a[2]);
b[3] = sm4Sbox(a[3]);
GET_ULONG_BE(bb,b,0)
rk = bb^(ROTL(bb, 13))^(ROTL(bb, 23));
return rk;
}
static void sm4_setkey( unsigned long SK[32], unsigned char key[16] )
{
unsigned long MK[4];
unsigned long k[36];
unsigned long i = 0;
GET_ULONG_BE( MK[0], key, 0 );
GET_ULONG_BE( MK[1], key, 4 );
GET_ULONG_BE( MK[2], key, 8 );
GET_ULONG_BE( MK[3], key, 12 );
k[0] = MK[0]^FK[0];
k[1] = MK[1]^FK[1];
k[2] = MK[2]^FK[2];
k[3] = MK[3]^FK[3];
for(; i<32; i++)
{
k[i+4] = k[i] ^ (sm4CalciRK(k[i+1]^k[i+2]^k[i+3]^CK[i]));
SK[i] = k[i+4];
}
}
static void sm4_one_round( unsigned long sk[32],
unsigned char input[16],
unsigned char output[16] )
{
unsigned long i = 0;
unsigned long ulbuf[36];
memset(ulbuf, 0, sizeof(ulbuf));
GET_ULONG_BE( ulbuf[0], input, 0 )
GET_ULONG_BE( ulbuf[1], input, 4 )
GET_ULONG_BE( ulbuf[2], input, 8 )
GET_ULONG_BE( ulbuf[3], input, 12 )
while(i<32)
{
ulbuf[i+4] = sm4F(ulbuf[i], ulbuf[i+1], ulbuf[i+2], ulbuf[i+3], sk[i]);
i++;
}
PUT_ULONG_BE(ulbuf[35],output,0);
PUT_ULONG_BE(ulbuf[34],output,4);
PUT_ULONG_BE(ulbuf[33],output,8);
PUT_ULONG_BE(ulbuf[32],output,12);
}
void SM4::sm4_setkey_enc( sm4_context *ctx, unsigned char key[16] )
{
ctx->mode = SM4_ENCRYPT;
sm4_setkey( ctx->sk, key );
}
void SM4::sm4_setkey_dec( sm4_context *ctx, unsigned char key[16] )
{
int i;
ctx->mode = SM4_ENCRYPT;
sm4_setkey( ctx->sk, key );
for( i = 0; i < 16; i ++ )
{
SWAP( ctx->sk[ i ], ctx->sk[ 31-i] );
}
}
void SM4::sm4_crypt_ecb( sm4_context *ctx,
int mode,
int length,
unsigned char *input,
unsigned char *output)
{
while( length > 0 )
{
sm4_one_round( ctx->sk, input, output );
input += 16;
output += 16;
length -= 16;
}
}
void SM4::sm4_crypt_cbc( sm4_context *ctx,
int mode,
int length,
unsigned char iv[16],
unsigned char *input,
unsigned char *output )
{
int i;
unsigned char temp[16];
if( mode == SM4_ENCRYPT )
{
while( length > 0 )
{
for( i = 0; i < 16; i++ )
output[i] = (unsigned char)( input[i] ^ iv[i] );
sm4_one_round( ctx->sk, output, output );
memcpy( iv, output, 16 );
input += 16;
output += 16;
length -= 16;
}
}
else /* SM4_DECRYPT */
{
while( length > 0 )
{
memcpy( temp, input, 16 );
sm4_one_round( ctx->sk, input, output );
for( i = 0; i < 16; i++ )
output[i] = (unsigned char)( output[i] ^ iv[i] );
memcpy( iv, temp, 16 );
input += 16;
output += 16;
length -= 16;
}
}
}
oldProject/rfid/sm4.h
+34
View File
@@ -0,0 +1,34 @@
#ifndef SM4_H
#define SM4_H
#define SM4_ENCRYPT 1
#define SM4_DECRYPT 0
typedef struct
{
int mode;
unsigned long sk[32];
}
sm4_context;
class SM4
{
public:
static void sm4_setkey_enc(sm4_context* ctx, unsigned char key[16]);
static void sm4_setkey_dec(sm4_context* ctx, unsigned char key[16]);
static void sm4_crypt_ecb(sm4_context* ctx,
int mode,
int length,
unsigned char* input,
unsigned char* output);
static void sm4_crypt_cbc(sm4_context* ctx,
int mode,
int length,
unsigned char iv[16],
unsigned char* input,
unsigned char* output);
};
#endif /* sm4.h */