mirror of https://github.com/PurpleI2P/i2pd.git
chertov
10 years ago
40 changed files with 1300 additions and 482 deletions
@ -0,0 +1,66 @@
@@ -0,0 +1,66 @@
|
||||
#include <inttypes.h> |
||||
#include "CryptoConst.h" |
||||
|
||||
namespace i2p |
||||
{ |
||||
namespace crypto |
||||
{ |
||||
const uint8_t elgp_[256]= |
||||
{ |
||||
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xC9, 0x0F, 0xDA, 0xA2, 0x21, 0x68, 0xC2, 0x34, |
||||
0xC4, 0xC6, 0x62, 0x8B, 0x80, 0xDC, 0x1C, 0xD1, 0x29, 0x02, 0x4E, 0x08, 0x8A, 0x67, 0xCC, 0x74, |
||||
0x02, 0x0B, 0xBE, 0xA6, 0x3B, 0x13, 0x9B, 0x22, 0x51, 0x4A, 0x08, 0x79, 0x8E, 0x34, 0x04, 0xDD, |
||||
0xEF, 0x95, 0x19, 0xB3, 0xCD, 0x3A, 0x43, 0x1B, 0x30, 0x2B, 0x0A, 0x6D, 0xF2, 0x5F, 0x14, 0x37, |
||||
0x4F, 0xE1, 0x35, 0x6D, 0x6D, 0x51, 0xC2, 0x45, 0xE4, 0x85, 0xB5, 0x76, 0x62, 0x5E, 0x7E, 0xC6, |
||||
0xF4, 0x4C, 0x42, 0xE9, 0xA6, 0x37, 0xED, 0x6B, 0x0B, 0xFF, 0x5C, 0xB6, 0xF4, 0x06, 0xB7, 0xED, |
||||
0xEE, 0x38, 0x6B, 0xFB, 0x5A, 0x89, 0x9F, 0xA5, 0xAE, 0x9F, 0x24, 0x11, 0x7C, 0x4B, 0x1F, 0xE6, |
||||
0x49, 0x28, 0x66, 0x51, 0xEC, 0xE4, 0x5B, 0x3D, 0xC2, 0x00, 0x7C, 0xB8, 0xA1, 0x63, 0xBF, 0x05, |
||||
0x98, 0xDA, 0x48, 0x36, 0x1C, 0x55, 0xD3, 0x9A, 0x69, 0x16, 0x3F, 0xA8, 0xFD, 0x24, 0xCF, 0x5F, |
||||
0x83, 0x65, 0x5D, 0x23, 0xDC, 0xA3, 0xAD, 0x96, 0x1C, 0x62, 0xF3, 0x56, 0x20, 0x85, 0x52, 0xBB, |
||||
0x9E, 0xD5, 0x29, 0x07, 0x70, 0x96, 0x96, 0x6D, 0x67, 0x0C, 0x35, 0x4E, 0x4A, 0xBC, 0x98, 0x04, |
||||
0xF1, 0x74, 0x6C, 0x08, 0xCA, 0x18, 0x21, 0x7C, 0x32, 0x90, 0x5E, 0x46, 0x2E, 0x36, 0xCE, 0x3B, |
||||
0xE3, 0x9E, 0x77, 0x2C, 0x18, 0x0E, 0x86, 0x03, 0x9B, 0x27, 0x83, 0xA2, 0xEC, 0x07, 0xA2, 0x8F, |
||||
0xB5, 0xC5, 0x5D, 0xF0, 0x6F, 0x4C, 0x52, 0xC9, 0xDE, 0x2B, 0xCB, 0xF6, 0x95, 0x58, 0x17, 0x18, |
||||
0x39, 0x95, 0x49, 0x7C, 0xEA, 0x95, 0x6A, 0xE5, 0x15, 0xD2, 0x26, 0x18, 0x98, 0xFA, 0x05, 0x10, |
||||
0x15, 0x72, 0x8E, 0x5A, 0x8A, 0xAC, 0xAA, 0x68, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF |
||||
}; |
||||
|
||||
const CryptoPP::Integer elgp (elgp_, 256); |
||||
const CryptoPP::Integer elgg (2); |
||||
|
||||
const uint8_t dsap_[128]= |
||||
{ |
||||
0x9c, 0x05, 0xb2, 0xaa, 0x96, 0x0d, 0x9b, 0x97, 0xb8, 0x93, 0x19, 0x63, 0xc9, 0xcc, 0x9e, 0x8c, |
||||
0x30, 0x26, 0xe9, 0xb8, 0xed, 0x92, 0xfa, 0xd0, 0xa6, 0x9c, 0xc8, 0x86, 0xd5, 0xbf, 0x80, 0x15, |
||||
0xfc, 0xad, 0xae, 0x31, 0xa0, 0xad, 0x18, 0xfa, 0xb3, 0xf0, 0x1b, 0x00, 0xa3, 0x58, 0xde, 0x23, |
||||
0x76, 0x55, 0xc4, 0x96, 0x4a, 0xfa, 0xa2, 0xb3, 0x37, 0xe9, 0x6a, 0xd3, 0x16, 0xb9, 0xfb, 0x1c, |
||||
0xc5, 0x64, 0xb5, 0xae, 0xc5, 0xb6, 0x9a, 0x9f, 0xf6, 0xc3, 0xe4, 0x54, 0x87, 0x07, 0xfe, 0xf8, |
||||
0x50, 0x3d, 0x91, 0xdd, 0x86, 0x02, 0xe8, 0x67, 0xe6, 0xd3, 0x5d, 0x22, 0x35, 0xc1, 0x86, 0x9c, |
||||
0xe2, 0x47, 0x9c, 0x3b, 0x9d, 0x54, 0x01, 0xde, 0x04, 0xe0, 0x72, 0x7f, 0xb3, 0x3d, 0x65, 0x11, |
||||
0x28, 0x5d, 0x4c, 0xf2, 0x95, 0x38, 0xd9, 0xe3, 0xb6, 0x05, 0x1f, 0x5b, 0x22, 0xcc, 0x1c, 0x93 |
||||
}; |
||||
|
||||
const uint8_t dsaq_[20]= |
||||
{ |
||||
0xa5, 0xdf, 0xc2, 0x8f, 0xef, 0x4c, 0xa1, 0xe2, 0x86, 0x74, 0x4c, 0xd8, 0xee, 0xd9, 0xd2, 0x9d, |
||||
0x68, 0x40, 0x46, 0xb7 |
||||
}; |
||||
|
||||
const uint8_t dsag_[128]= |
||||
{ |
||||
0x0c, 0x1f, 0x4d, 0x27, 0xd4, 0x00, 0x93, 0xb4, 0x29, 0xe9, 0x62, 0xd7, 0x22, 0x38, 0x24, 0xe0, |
||||
0xbb, 0xc4, 0x7e, 0x7c, 0x83, 0x2a, 0x39, 0x23, 0x6f, 0xc6, 0x83, 0xaf, 0x84, 0x88, 0x95, 0x81, |
||||
0x07, 0x5f, 0xf9, 0x08, 0x2e, 0xd3, 0x23, 0x53, 0xd4, 0x37, 0x4d, 0x73, 0x01, 0xcd, 0xa1, 0xd2, |
||||
0x3c, 0x43, 0x1f, 0x46, 0x98, 0x59, 0x9d, 0xda, 0x02, 0x45, 0x18, 0x24, 0xff, 0x36, 0x97, 0x52, |
||||
0x59, 0x36, 0x47, 0xcc, 0x3d, 0xdc, 0x19, 0x7d, 0xe9, 0x85, 0xe4, 0x3d, 0x13, 0x6c, 0xdc, 0xfc, |
||||
0x6b, 0xd5, 0x40, 0x9c, 0xd2, 0xf4, 0x50, 0x82, 0x11, 0x42, 0xa5, 0xe6, 0xf8, 0xeb, 0x1c, 0x3a, |
||||
0xb5, 0xd0, 0x48, 0x4b, 0x81, 0x29, 0xfc, 0xf1, 0x7b, 0xce, 0x4f, 0x7f, 0x33, 0x32, 0x1c, 0x3c, |
||||
0xb3, 0xdb, 0xb1, 0x4a, 0x90, 0x5e, 0x7b, 0x2b, 0x3e, 0x93, 0xbe, 0x47, 0x08, 0xcb, 0xcc, 0x82 |
||||
}; |
||||
|
||||
const CryptoPP::Integer dsap (dsap_, 128); |
||||
const CryptoPP::Integer dsaq (dsaq_, 20); |
||||
const CryptoPP::Integer dsag (dsag_, 128); |
||||
} |
||||
} |
||||
|
||||
@ -1,20 +1,29 @@
@@ -1,20 +1,29 @@
|
||||
#include "Log.h" |
||||
|
||||
#include "Daemon.h" |
||||
|
||||
Log g_Log; |
||||
|
||||
void LogMsg::Process() |
||||
{ |
||||
if (Daemon.isLogging == 1 && Daemon.logfile.is_open()) |
||||
Daemon.logfile << s.str(); |
||||
|
||||
output << s.str(); |
||||
|
||||
std::cout << s.str (); // TODO: delete later
|
||||
} |
||||
|
||||
void Log::Flush () |
||||
{ |
||||
if (Daemon.isLogging == 1 && Daemon.logfile.is_open()) |
||||
Daemon.logfile.flush(); |
||||
if (m_LogFile) |
||||
m_LogFile->flush(); |
||||
} |
||||
|
||||
void Log::SetLogFile (const std::string& fullFilePath) |
||||
{ |
||||
if (m_LogFile) delete m_LogFile; |
||||
m_LogFile = new std::ofstream (fullFilePath, std::ofstream::out | std::ofstream::binary | std::ofstream::trunc); |
||||
if (m_LogFile->is_open ()) |
||||
LogPrint("Logging to file ", fullFilePath, " enabled."); |
||||
else |
||||
{ |
||||
delete m_LogFile; |
||||
m_LogFile = nullptr; |
||||
} |
||||
} |
||||
|
||||
@ -0,0 +1,43 @@
@@ -0,0 +1,43 @@
|
||||
#CC = clang++
|
||||
CC = g++ |
||||
CFLAGS = -g -Wall -std=c++11 -lstdc++ |
||||
OBJECTS = obj/CryptoConst.o obj/base64.o obj/NTCPSession.o obj/RouterInfo.o obj/Transports.o \
|
||||
obj/RouterContext.o obj/NetDb.o obj/LeaseSet.o obj/Tunnel.o obj/TunnelEndpoint.o \
|
||||
obj/TunnelGateway.o obj/TransitTunnel.o obj/I2NPProtocol.o obj/Log.o obj/Garlic.o \
|
||||
obj/HTTPServer.o obj/Streaming.o obj/Identity.o obj/SSU.o obj/util.o obj/Reseed.o \
|
||||
obj/UPnP.o obj/TunnelPool.o obj/HTTPProxy.o obj/AddressBook.o obj/Daemon.o \
|
||||
obj/DaemonLinux.o obj/SSUData.o obj/i2p.o obj/aes.o |
||||
INCFLAGS = -DCRYPTOPP_DISABLE_ASM |
||||
LDFLAGS = -Wl,-rpath,/usr/local/lib -lcryptopp -lboost_system -lboost_filesystem -lboost_regex -lboost_program_options -lpthread |
||||
LIBS = |
||||
|
||||
#check if AES-NI is supported by CPU
|
||||
ifneq ($(shell grep -c aes /proc/cpuinfo),0) |
||||
CPU_FLAGS = -DAESNI |
||||
endif |
||||
|
||||
# Apple Mac OSX
|
||||
UNAME_S := $(shell uname -s) |
||||
ifeq ($(UNAME_S),Darwin) |
||||
endif |
||||
|
||||
all: obj i2p |
||||
|
||||
i2p: $(OBJECTS:obj/%=obj/%) |
||||
$(CC) -o $@ $^ $(LDFLAGS) $(LIBS) |
||||
|
||||
.SUFFIXES: |
||||
.SUFFIXES: .c .cc .C .cpp .o |
||||
|
||||
obj/%.o : %.cpp |
||||
$(CC) -o $@ $< -c $(CFLAGS) $(INCFLAGS) $(CPU_FLAGS) |
||||
|
||||
obj: |
||||
mkdir -p obj |
||||
|
||||
clean: |
||||
rm -fr obj i2p |
||||
|
||||
.PHONY: all |
||||
.PHONY: clean |
||||
|
||||
@ -0,0 +1,357 @@
@@ -0,0 +1,357 @@
|
||||
#include <stdlib.h> |
||||
#include "TunnelBase.h" |
||||
#include "aes.h" |
||||
|
||||
namespace i2p |
||||
{ |
||||
namespace crypto |
||||
{ |
||||
|
||||
#ifdef AESNI |
||||
|
||||
ECBCryptoAESNI::ECBCryptoAESNI () |
||||
{ |
||||
m_KeySchedule = m_UnalignedBuffer; |
||||
uint8_t rem = ((uint64_t)m_KeySchedule) & 0x0f; |
||||
if (rem) |
||||
m_KeySchedule += (16 - rem); |
||||
} |
||||
|
||||
#define KeyExpansion256(round0,round1) \ |
||||
"pshufd $0xff, %%xmm2, %%xmm2 \n" \ |
||||
"movaps %%xmm1, %%xmm4 \n" \ |
||||
"pslldq $4, %%xmm4 \n" \ |
||||
"pxor %%xmm4, %%xmm1 \n" \ |
||||
"pslldq $4, %%xmm4 \n" \ |
||||
"pxor %%xmm4, %%xmm1 \n" \ |
||||
"pslldq $4, %%xmm4 \n" \ |
||||
"pxor %%xmm4, %%xmm1 \n" \ |
||||
"pxor %%xmm2, %%xmm1 \n" \ |
||||
"movaps %%xmm1, "#round0"(%[sched]) \n" \ |
||||
"aeskeygenassist $0, %%xmm1, %%xmm4 \n" \ |
||||
"pshufd $0xaa, %%xmm4, %%xmm2 \n" \ |
||||
"movaps %%xmm3, %%xmm4 \n" \ |
||||
"pslldq $4, %%xmm4 \n" \ |
||||
"pxor %%xmm4, %%xmm3 \n" \ |
||||
"pslldq $4, %%xmm4 \n" \ |
||||
"pxor %%xmm4, %%xmm3 \n" \ |
||||
"pslldq $4, %%xmm4 \n" \ |
||||
"pxor %%xmm4, %%xmm3 \n" \ |
||||
"pxor %%xmm2, %%xmm3 \n" \ |
||||
"movaps %%xmm3, "#round1"(%[sched]) \n" |
||||
|
||||
void ECBCryptoAESNI::ExpandKey (const uint8_t * key) |
||||
{ |
||||
__asm__ |
||||
( |
||||
"movups (%[key]), %%xmm1 \n" |
||||
"movups 16(%[key]), %%xmm3 \n" |
||||
"movaps %%xmm1, (%[sched]) \n" |
||||
"movaps %%xmm3, 16(%[sched]) \n" |
||||
"aeskeygenassist $1, %%xmm3, %%xmm2 \n" |
||||
KeyExpansion256(32,48) |
||||
"aeskeygenassist $2, %%xmm3, %%xmm2 \n" |
||||
KeyExpansion256(64,80) |
||||
"aeskeygenassist $4, %%xmm3, %%xmm2 \n" |
||||
KeyExpansion256(96,112) |
||||
"aeskeygenassist $8, %%xmm3, %%xmm2 \n" |
||||
KeyExpansion256(128,144) |
||||
"aeskeygenassist $16, %%xmm3, %%xmm2 \n" |
||||
KeyExpansion256(160,176) |
||||
"aeskeygenassist $32, %%xmm3, %%xmm2 \n" |
||||
KeyExpansion256(192,208) |
||||
"aeskeygenassist $64, %%xmm3, %%xmm2 \n" |
||||
// key expansion final
|
||||
"pshufd $0xff, %%xmm2, %%xmm2 \n" |
||||
"movaps %%xmm1, %%xmm4 \n" |
||||
"pslldq $4, %%xmm4 \n" |
||||
"pxor %%xmm4, %%xmm1 \n" |
||||
"pslldq $4, %%xmm4 \n" |
||||
"pxor %%xmm4, %%xmm1 \n" |
||||
"pslldq $4, %%xmm4 \n" |
||||
"pxor %%xmm4, %%xmm1 \n" |
||||
"pxor %%xmm2, %%xmm1 \n" |
||||
"movups %%xmm1, 224(%[sched]) \n" |
||||
: // output
|
||||
: [key]"r"(key), [sched]"r"(m_KeySchedule) // input
|
||||
: "%xmm1", "%xmm2", "%xmm3", "%xmm4" // clogged
|
||||
); |
||||
} |
||||
|
||||
#define EncryptAES256(sched) \ |
||||
"pxor (%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 16(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 32(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 48(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 64(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 80(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 96(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 112(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 128(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 144(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 160(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 176(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 192(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenc 208(%["#sched"]), %%xmm0 \n" \ |
||||
"aesenclast 224(%["#sched"]), %%xmm0 \n" |
||||
|
||||
void ECBEncryptionAESNI::Encrypt (const ChipherBlock * in, ChipherBlock * out) |
||||
{ |
||||
__asm__ |
||||
( |
||||
"movups (%[in]), %%xmm0 \n" |
||||
EncryptAES256(sched) |
||||
"movups %%xmm0, (%[out]) \n" |
||||
: : [sched]"r"(m_KeySchedule), [in]"r"(in), [out]"r"(out) : "%xmm0" |
||||
); |
||||
} |
||||
|
||||
#define DecryptAES256(sched) \ |
||||
"pxor 224(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 208(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 192(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 176(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 160(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 144(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 128(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 112(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 96(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 80(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 64(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 48(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 32(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdec 16(%["#sched"]), %%xmm0 \n" \ |
||||
"aesdeclast (%["#sched"]), %%xmm0 \n" |
||||
|
||||
void ECBDecryptionAESNI::Decrypt (const ChipherBlock * in, ChipherBlock * out) |
||||
{ |
||||
__asm__ |
||||
( |
||||
"movups (%[in]), %%xmm0 \n" |
||||
DecryptAES256(sched) |
||||
"movups %%xmm0, (%[out]) \n" |
||||
: : [sched]"r"(m_KeySchedule), [in]"r"(in), [out]"r"(out) : "%xmm0" |
||||
); |
||||
} |
||||
|
||||
#define CallAESIMC(offset) \ |
||||
"movaps "#offset"(%[shed]), %%xmm0 \n" \ |
||||
"aesimc %%xmm0, %%xmm0 \n" \ |
||||
"movaps %%xmm0, "#offset"(%[shed]) \n" |
||||
|
||||
void ECBDecryptionAESNI::SetKey (const uint8_t * key) |
||||
{ |
||||
ExpandKey (key); // expand encryption key first
|
||||
// then invert it using aesimc
|
||||
__asm__ |
||||
( |
||||
CallAESIMC(16) |
||||
CallAESIMC(32) |
||||
CallAESIMC(48) |
||||
CallAESIMC(64) |
||||
CallAESIMC(80) |
||||
CallAESIMC(96) |
||||
CallAESIMC(112) |
||||
CallAESIMC(128) |
||||
CallAESIMC(144) |
||||
CallAESIMC(160) |
||||
CallAESIMC(176) |
||||
CallAESIMC(192) |
||||
CallAESIMC(208) |
||||
: : [shed]"r"(m_KeySchedule) : "%xmm0" |
||||
); |
||||
} |
||||
|
||||
#endif |
||||
|
||||
|
||||
void CBCEncryption::Encrypt (int numBlocks, const ChipherBlock * in, ChipherBlock * out) |
||||
{ |
||||
#ifdef AESNI |
||||
__asm__ |
||||
( |
||||
"movups (%[iv]), %%xmm1 \n" |
||||
"block_e: \n" |
||||
"movups (%[in]), %%xmm0 \n" |
||||
"pxor %%xmm1, %%xmm0 \n" |
||||
EncryptAES256(sched) |
||||
"movaps %%xmm0, %%xmm1 \n" |
||||
"movups %%xmm0, (%[out]) \n" |
||||
"add $16, %[in] \n" |
||||
"add $16, %[out] \n" |
||||
"dec %[num] \n" |
||||
"jnz block_e; \n" |
||||
"movups %%xmm1, (%[iv]) \n" |
||||
: |
||||
: [iv]"r"(&m_LastBlock), [sched]"r"(m_ECBEncryption.GetKeySchedule ()), |
||||
[in]"r"(in), [out]"r"(out), [num]"r"(numBlocks) |
||||
: "%xmm0", "%xmm1", "cc", "memory" |
||||
); |
||||
#else |
||||
for (int i = 0; i < numBlocks; i++) |
||||
{ |
||||
m_LastBlock ^= in[i]; |
||||
m_ECBEncryption.Encrypt (&m_LastBlock, &m_LastBlock); |
||||
out[i] = m_LastBlock; |
||||
} |
||||
#endif |
||||
} |
||||
|
||||
void CBCEncryption::Encrypt (const uint8_t * in, std::size_t len, uint8_t * out) |
||||
{ |
||||
// len/16
|
||||
Encrypt (len >> 4, (const ChipherBlock *)in, (ChipherBlock *)out); |
||||
} |
||||
|
||||
void CBCEncryption::Encrypt (const uint8_t * in, uint8_t * out) |
||||
{ |
||||
#ifdef AESNI |
||||
__asm__ |
||||
( |
||||
"movups (%[iv]), %%xmm1 \n" |
||||
"movups (%[in]), %%xmm0 \n" |
||||
"pxor %%xmm1, %%xmm0 \n" |
||||
EncryptAES256(sched) |
||||
"movups %%xmm0, (%[out]) \n" |
||||
"movups %%xmm0, (%[iv]) \n" |
||||
: |
||||
: [iv]"r"(&m_LastBlock), [sched]"r"(m_ECBEncryption.GetKeySchedule ()), |
||||
[in]"r"(in), [out]"r"(out) |
||||
: "%xmm0", "%xmm1", "memory" |
||||
); |
||||
#else |
||||
Encrypt (1, (const ChipherBlock *)in, (ChipherBlock *)out); |
||||
#endif |
||||
} |
||||
|
||||
void CBCDecryption::Decrypt (int numBlocks, const ChipherBlock * in, ChipherBlock * out) |
||||
{ |
||||
#ifdef AESNI |
||||
__asm__ |
||||
( |
||||
"movups (%[iv]), %%xmm1 \n" |
||||
"block_d: \n" |
||||
"movups (%[in]), %%xmm0 \n" |
||||
"movaps %%xmm0, %%xmm2 \n" |
||||
DecryptAES256(sched) |
||||
"pxor %%xmm1, %%xmm0 \n" |
||||
"movups %%xmm0, (%[out]) \n" |
||||
"movaps %%xmm2, %%xmm1 \n" |
||||
"add $16, %[in] \n" |
||||
"add $16, %[out] \n" |
||||
"dec %[num] \n" |
||||
"jnz block_d; \n" |
||||
"movups %%xmm1, (%[iv]) \n" |
||||
: |
||||
: [iv]"r"(&m_IV), [sched]"r"(m_ECBDecryption.GetKeySchedule ()), |
||||
[in]"r"(in), [out]"r"(out), [num]"r"(numBlocks) |
||||
: "%xmm0", "%xmm1", "%xmm2", "cc", "memory" |
||||
); |
||||
#else |
||||
for (int i = 0; i < numBlocks; i++) |
||||
{ |
||||
ChipherBlock tmp = in[i]; |
||||
m_ECBDecryption.Decrypt (in + i, out + i); |
||||
out[i] ^= m_IV; |
||||
m_IV = tmp; |
||||
} |
||||
#endif |
||||
} |
||||
|
||||
void CBCDecryption::Decrypt (const uint8_t * in, std::size_t len, uint8_t * out) |
||||
{ |
||||
Decrypt (len >> 4, (const ChipherBlock *)in, (ChipherBlock *)out); |
||||
} |
||||
|
||||
void CBCDecryption::Decrypt (const uint8_t * in, uint8_t * out) |
||||
{ |
||||
#ifdef AESNI |
||||
__asm__ |
||||
( |
||||
"movups (%[iv]), %%xmm1 \n" |
||||
"movups (%[in]), %%xmm0 \n" |
||||
"movups %%xmm0, (%[iv]) \n" |
||||
DecryptAES256(sched) |
||||
"pxor %%xmm1, %%xmm0 \n" |
||||
"movups %%xmm0, (%[out]) \n" |
||||
: |
||||
: [iv]"r"(&m_IV), [sched]"r"(m_ECBDecryption.GetKeySchedule ()), |
||||
[in]"r"(in), [out]"r"(out) |
||||
: "%xmm0", "%xmm1", "memory" |
||||
); |
||||
#else |
||||
Decrypt (1, (const ChipherBlock *)in, (ChipherBlock *)out); |
||||
#endif |
||||
} |
||||
|
||||
void TunnelEncryption::Encrypt (uint8_t * payload) |
||||
{ |
||||
#ifdef AESNI |
||||
__asm__ |
||||
( |
||||
// encrypt IV
|
||||
"movups (%[payload]), %%xmm0 \n" |
||||
EncryptAES256(sched_iv) |
||||
"movaps %%xmm0, %%xmm1 \n" |
||||
// double IV encryption
|
||||
EncryptAES256(sched_iv) |
||||
"movups %%xmm0, (%[payload]) \n" |
||||
// encrypt data, IV is xmm1
|
||||
"block_et: \n" |
||||
"add $16, %[payload] \n" |
||||
"movups (%[payload]), %%xmm0 \n" |
||||
"pxor %%xmm1, %%xmm0 \n" |
||||
EncryptAES256(sched_l) |
||||
"movaps %%xmm0, %%xmm1 \n" |
||||
"movups %%xmm0, (%[payload]) \n" |
||||
"dec %[num] \n" |
||||
"jnz block_et; \n" |
||||
: |
||||
: [sched_iv]"r"(m_IVEncryption.GetKeySchedule ()), [sched_l]"r"(m_LayerEncryption.GetKeySchedule ()), |
||||
[payload]"r"(payload), [num]"r"(63) // 63 blocks = 1008 bytes
|
||||
: "%xmm0", "%xmm1", "cc", "memory" |
||||
); |
||||
#else |
||||
m_IVEncryption.Encrypt ((ChipherBlock *)payload, (ChipherBlock *)payload); // iv
|
||||
m_LayerEncryption.Encrypt (payload + 16, i2p::tunnel::TUNNEL_DATA_ENCRYPTED_SIZE, payload + 16); // data
|
||||
m_IVEncryption.Encrypt ((ChipherBlock *)payload, (ChipherBlock *)payload); // double iv
|
||||
#endif |
||||
} |
||||
|
||||
void TunnelDecryption::Decrypt (uint8_t * payload) |
||||
{ |
||||
#ifdef AESNI |
||||
__asm__ |
||||
( |
||||
// decrypt IV
|
||||
"movups (%[payload]), %%xmm0 \n" |
||||
DecryptAES256(sched_iv) |
||||
"movaps %%xmm0, %%xmm1 \n" |
||||
// double IV encryption
|
||||
DecryptAES256(sched_iv) |
||||
"movups %%xmm0, (%[payload]) \n" |
||||
// decrypt data, IV is xmm1
|
||||
"block_dt: \n" |
||||
"add $16, %[payload] \n" |
||||
"movups (%[payload]), %%xmm0 \n" |
||||
"movaps %%xmm0, %%xmm2 \n" |
||||
DecryptAES256(sched_l) |
||||
"pxor %%xmm1, %%xmm0 \n" |
||||
"movups %%xmm0, (%[payload]) \n" |
||||
"movaps %%xmm2, %%xmm1 \n" |
||||
"dec %[num] \n" |
||||
"jnz block_dt; \n" |
||||
: |
||||
: [sched_iv]"r"(m_IVDecryption.GetKeySchedule ()), [sched_l]"r"(m_LayerDecryption.GetKeySchedule ()), |
||||
[payload]"r"(payload), [num]"r"(63) // 63 blocks = 1008 bytes
|
||||
: "%xmm0", "%xmm1", "%xmm2", "cc", "memory" |
||||
); |
||||
#else |
||||
m_IVDecryption.Decrypt ((ChipherBlock *)payload, (ChipherBlock *)payload); // iv
|
||||
m_LayerDecryption.Decrypt (payload + 16, i2p::tunnel::TUNNEL_DATA_ENCRYPTED_SIZE, payload + 16); // data
|
||||
m_IVDecryption.Decrypt ((ChipherBlock *)payload, (ChipherBlock *)payload); // double iv
|
||||
#endif |
||||
} |
||||
} |
||||
} |
||||
|
||||
@ -0,0 +1,188 @@
@@ -0,0 +1,188 @@
|
||||
#ifndef AES_H__ |
||||
#define AES_H__ |
||||
|
||||
#include <inttypes.h> |
||||
#include <cryptopp/modes.h> |
||||
#include <cryptopp/aes.h> |
||||
|
||||
namespace i2p |
||||
{ |
||||
namespace crypto |
||||
{ |
||||
union ChipherBlock |
||||
{ |
||||
uint8_t buf[16]; |
||||
uint64_t ll[2]; |
||||
|
||||
void operator^=(const ChipherBlock& other) // XOR
|
||||
{ |
||||
ll[0] ^= other.ll[0]; |
||||
ll[1] ^= other.ll[1]; |
||||
} |
||||
}; |
||||
|
||||
#ifdef AESNI |
||||
class ECBCryptoAESNI |
||||
{ |
||||
public: |
||||
|
||||
ECBCryptoAESNI (); |
||||
uint8_t * GetKeySchedule () { return m_KeySchedule; }; |
||||
|
||||
protected: |
||||
|
||||
void ExpandKey (const uint8_t * key); |
||||
|
||||
protected: |
||||
|
||||
uint8_t * m_KeySchedule; // start of 16 bytes boundary of m_UnalignedBuffer
|
||||
uint8_t m_UnalignedBuffer[256]; // 14 rounds for AES-256, 240 + 16 bytes
|
||||
}; |
||||
|
||||
class ECBEncryptionAESNI: public ECBCryptoAESNI |
||||
{ |
||||
public: |
||||
|
||||
void SetKey (const uint8_t * key) { ExpandKey (key); }; |
||||
void Encrypt (const ChipherBlock * in, ChipherBlock * out); |
||||
}; |
||||
|
||||
class ECBDecryptionAESNI: public ECBCryptoAESNI |
||||
{ |
||||
public: |
||||
|
||||
void SetKey (const uint8_t * key); |
||||
void Decrypt (const ChipherBlock * in, ChipherBlock * out); |
||||
}; |
||||
|
||||
typedef ECBEncryptionAESNI ECBEncryption; |
||||
typedef ECBDecryptionAESNI ECBDecryption; |
||||
|
||||
#else // use crypto++
|
||||
|
||||
class ECBEncryption |
||||
{ |
||||
public: |
||||
|
||||
void SetKey (const uint8_t * key) |
||||
{ |
||||
m_Encryption.SetKey (key, 32); |
||||
} |
||||
void Encrypt (const ChipherBlock * in, ChipherBlock * out) |
||||
{ |
||||
m_Encryption.ProcessData (out->buf, in->buf, 16); |
||||
} |
||||
|
||||
private: |
||||
|
||||
CryptoPP::ECB_Mode<CryptoPP::AES>::Encryption m_Encryption; |
||||
}; |
||||
|
||||
class ECBDecryption |
||||
{ |
||||
public: |
||||
|
||||
void SetKey (const uint8_t * key) |
||||
{ |
||||
m_Decryption.SetKey (key, 32); |
||||
} |
||||
void Decrypt (const ChipherBlock * in, ChipherBlock * out) |
||||
{ |
||||
m_Decryption.ProcessData (out->buf, in->buf, 16); |
||||
} |
||||
|
||||
private: |
||||
|
||||
CryptoPP::ECB_Mode<CryptoPP::AES>::Decryption m_Decryption; |
||||
}; |
||||
|
||||
|
||||
#endif |
||||
|
||||
class CBCEncryption |
||||
{ |
||||
public: |
||||
|
||||
CBCEncryption () { memset (m_LastBlock.buf, 0, 16); }; |
||||
|
||||
void SetKey (const uint8_t * key) { m_ECBEncryption.SetKey (key); }; // 32 bytes
|
||||
void SetIV (const uint8_t * iv) { memcpy (m_LastBlock.buf, iv, 16); }; // 16 bytes
|
||||
|
||||
void Encrypt (int numBlocks, const ChipherBlock * in, ChipherBlock * out); |
||||
void Encrypt (const uint8_t * in, std::size_t len, uint8_t * out); |
||||
void Encrypt (const uint8_t * in, uint8_t * out); // one block
|
||||
|
||||
private: |
||||
|
||||
ChipherBlock m_LastBlock; |
||||
|
||||
ECBEncryption m_ECBEncryption; |
||||
}; |
||||
|
||||
class CBCDecryption |
||||
{ |
||||
public: |
||||
|
||||
CBCDecryption () { memset (m_IV.buf, 0, 16); }; |
||||
|
||||
void SetKey (const uint8_t * key) { m_ECBDecryption.SetKey (key); }; // 32 bytes
|
||||
void SetIV (const uint8_t * iv) { memcpy (m_IV.buf, iv, 16); }; // 16 bytes
|
||||
|
||||
void Decrypt (int numBlocks, const ChipherBlock * in, ChipherBlock * out); |
||||
void Decrypt (const uint8_t * in, std::size_t len, uint8_t * out); |
||||
void Decrypt (const uint8_t * in, uint8_t * out); // one block
|
||||
|
||||
private: |
||||
|
||||
ChipherBlock m_IV; |
||||
ECBDecryption m_ECBDecryption; |
||||
}; |
||||
|
||||
class TunnelEncryption // with double IV encryption
|
||||
{ |
||||
public: |
||||
|
||||
void SetKeys (const uint8_t * layerKey, const uint8_t * ivKey) |
||||
{ |
||||
m_LayerEncryption.SetKey (layerKey); |
||||
m_IVEncryption.SetKey (ivKey); |
||||
} |
||||
|
||||
void Encrypt (uint8_t * payload); // 1024 bytes (16 IV + 1008 data)
|
||||
|
||||
private: |
||||
|
||||
ECBEncryption m_IVEncryption; |
||||
#ifdef AESNI |
||||
ECBEncryption m_LayerEncryption; |
||||
#else |
||||
CBCEncryption m_LayerEncryption; |
||||
#endif |
||||
}; |
||||
|
||||
class TunnelDecryption // with double IV encryption
|
||||
{ |
||||
public: |
||||
|
||||
void SetKeys (const uint8_t * layerKey, const uint8_t * ivKey) |
||||
{ |
||||
m_LayerDecryption.SetKey (layerKey); |
||||
m_IVDecryption.SetKey (ivKey); |
||||
} |
||||
|
||||
void Decrypt (uint8_t * payload); // 1024 bytes (16 IV + 1008 data)
|
||||
|
||||
private: |
||||
|
||||
ECBDecryption m_IVDecryption; |
||||
#ifdef AESNI |
||||
ECBDecryption m_LayerDecryption; |
||||
#else |
||||
CBCDecryption m_LayerDecryption; |
||||
#endif |
||||
}; |
||||
} |
||||
} |
||||
|
||||
#endif |
||||
|
||||
Loading…
Reference in new issue