修改文件换行符，修正轮班图元长度计算问题
This commit is contained in:
+639
-639
File diff suppressed because it is too large
Load Diff
+171
-171
@@ -1,171 +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;; // 串口对象
|
||||
|
||||
};
|
||||
#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;; // 串口对象
|
||||
|
||||
};
|
||||
|
||||
+231
-231
@@ -1,231 +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;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
#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;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
+34
-34
@@ -1,34 +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 */
|
||||
#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 */
|
||||
|
||||
Reference in New Issue
Block a user