1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
|
#pragma once
// https://www.schneier.com/academic/archives/1994/09/description_of_a_new.html
#include "blowfish_init.hpp"
#include <algorithm>
namespace Blowfish {
template <std::size_t sz> concept is_valid_key_length = (sz < KEYLEN);
struct Block {
constexpr Block(uint64_t x) {
static_assert(sizeof(Block) == sizeof(uint64_t));
L = x >> 32;
R = x & 0xffffffff;
}
constexpr Block(uint32_t l, uint32_t r) : L(l), R(r) {
static_assert(sizeof(Block) == sizeof(uint64_t));
}
constexpr operator uint64_t() const {
return (static_cast<uint64_t>(L) << 32) + R;
}
uint32_t L;
uint32_t R;
};
template <std::size_t keylen>
requires is_valid_key_length<keylen> class Context {
public:
constexpr Context(const std::array<uint8_t, keylen> &key) {
for (std::size_t i = 0; i < BOXES; ++i) {
std::copy(S_INIT[i].begin(), S_INIT[i].end(), S[i].begin());
}
//
std::size_t k = 0;
for (std::size_t i = 0; i < SUBKEYS; ++i) {
uint32_t qk = 0;
for (std::size_t j = 0; j < 4; ++j) {
qk = (qk << 8) | key[k];
++k;
if (k >= keylen) {
k = 0;
}
}
P[i] = P_INIT[i] ^ qk;
}
Block x(0, 0);
for (std::size_t i = 0; i < SUBKEYS; i += 2) {
x = encrypt(x);
P[i] = x.L;
P[i + 1] = x.R;
}
for (std::size_t i = 0; i < BOXES; ++i) {
for (std::size_t j = 0; j < ENTRIES; j += 2) {
x = encrypt(x);
S[i][j] = x.L;
S[i][j + 1] = x.R;
}
}
}
constexpr Block encrypt(const Block &x) const {
Block y(x);
for (std::size_t i = 0; i < ROUNDS; ++i) {
y.L = y.L ^ P[i];
y.R = F(y.L) ^ y.R;
std::swap(y.L, y.R);
}
std::swap(y.L, y.R);
y.R = y.R ^ P[16];
y.L = y.L ^ P[17];
return y;
}
constexpr Block decrypt(const Block &x) const {
Block y(x);
for (std::size_t i = ROUNDS + 1; i > 1; --i) {
y.L = y.L ^ P[i];
y.R = F(y.L) ^ y.R;
std::swap(y.L, y.R);
}
std::swap(y.L, y.R);
y.R = y.R ^ P[1];
y.L = y.L ^ P[0];
return y;
}
private:
constexpr uint32_t F(uint32_t x) const {
const uint8_t a = (x >> 24) & 0xff;
const uint8_t b = (x >> 16) & 0xff;
const uint8_t c = (x >> 8) & 0xff;
const uint8_t d = x & 0xff;
uint32_t y = S[0][a] + S[1][b];
y = y ^ S[2][c];
y = y + S[3][d];
return y;
}
std::array<uint32_t, SUBKEYS> P;
std::array<std::array<uint32_t, ENTRIES>, BOXES> S;
};
} // namespace Blowfish
|