1
2
3
4
5
6
7
8
9
10#include <crypto/internal/aead.h>
11#include <crypto/internal/simd.h>
12#include <crypto/internal/skcipher.h>
13#include <crypto/scatterwalk.h>
14#include <linux/module.h>
15#include <asm/fpu/api.h>
16#include <asm/cpu_device_id.h>
17
18#define AEGIS128L_BLOCK_ALIGN 16
19#define AEGIS128L_BLOCK_SIZE 32
20#define AEGIS128L_NONCE_SIZE 16
21#define AEGIS128L_STATE_BLOCKS 8
22#define AEGIS128L_KEY_SIZE 16
23#define AEGIS128L_MIN_AUTH_SIZE 8
24#define AEGIS128L_MAX_AUTH_SIZE 16
25
26asmlinkage void crypto_aegis128l_aesni_init(void *state, void *key, void *iv);
27
28asmlinkage void crypto_aegis128l_aesni_ad(
29 void *state, unsigned int length, const void *data);
30
31asmlinkage void crypto_aegis128l_aesni_enc(
32 void *state, unsigned int length, const void *src, void *dst);
33
34asmlinkage void crypto_aegis128l_aesni_dec(
35 void *state, unsigned int length, const void *src, void *dst);
36
37asmlinkage void crypto_aegis128l_aesni_enc_tail(
38 void *state, unsigned int length, const void *src, void *dst);
39
40asmlinkage void crypto_aegis128l_aesni_dec_tail(
41 void *state, unsigned int length, const void *src, void *dst);
42
43asmlinkage void crypto_aegis128l_aesni_final(
44 void *state, void *tag_xor, unsigned int cryptlen,
45 unsigned int assoclen);
46
47struct aegis_block {
48 u8 bytes[AEGIS128L_BLOCK_SIZE] __aligned(AEGIS128L_BLOCK_ALIGN);
49};
50
51struct aegis_state {
52 struct aegis_block blocks[AEGIS128L_STATE_BLOCKS];
53};
54
55struct aegis_ctx {
56 struct aegis_block key;
57};
58
59struct aegis_crypt_ops {
60 int (*skcipher_walk_init)(struct skcipher_walk *walk,
61 struct aead_request *req, bool atomic);
62
63 void (*crypt_blocks)(void *state, unsigned int length, const void *src,
64 void *dst);
65 void (*crypt_tail)(void *state, unsigned int length, const void *src,
66 void *dst);
67};
68
69static void crypto_aegis128l_aesni_process_ad(
70 struct aegis_state *state, struct scatterlist *sg_src,
71 unsigned int assoclen)
72{
73 struct scatter_walk walk;
74 struct aegis_block buf;
75 unsigned int pos = 0;
76
77 scatterwalk_start(&walk, sg_src);
78 while (assoclen != 0) {
79 unsigned int size = scatterwalk_clamp(&walk, assoclen);
80 unsigned int left = size;
81 void *mapped = scatterwalk_map(&walk);
82 const u8 *src = (const u8 *)mapped;
83
84 if (pos + size >= AEGIS128L_BLOCK_SIZE) {
85 if (pos > 0) {
86 unsigned int fill = AEGIS128L_BLOCK_SIZE - pos;
87 memcpy(buf.bytes + pos, src, fill);
88 crypto_aegis128l_aesni_ad(state,
89 AEGIS128L_BLOCK_SIZE,
90 buf.bytes);
91 pos = 0;
92 left -= fill;
93 src += fill;
94 }
95
96 crypto_aegis128l_aesni_ad(state, left, src);
97
98 src += left & ~(AEGIS128L_BLOCK_SIZE - 1);
99 left &= AEGIS128L_BLOCK_SIZE - 1;
100 }
101
102 memcpy(buf.bytes + pos, src, left);
103 pos += left;
104 assoclen -= size;
105
106 scatterwalk_unmap(mapped);
107 scatterwalk_advance(&walk, size);
108 scatterwalk_done(&walk, 0, assoclen);
109 }
110
111 if (pos > 0) {
112 memset(buf.bytes + pos, 0, AEGIS128L_BLOCK_SIZE - pos);
113 crypto_aegis128l_aesni_ad(state, AEGIS128L_BLOCK_SIZE, buf.bytes);
114 }
115}
116
117static void crypto_aegis128l_aesni_process_crypt(
118 struct aegis_state *state, struct skcipher_walk *walk,
119 const struct aegis_crypt_ops *ops)
120{
121 while (walk->nbytes >= AEGIS128L_BLOCK_SIZE) {
122 ops->crypt_blocks(state, round_down(walk->nbytes,
123 AEGIS128L_BLOCK_SIZE),
124 walk->src.virt.addr, walk->dst.virt.addr);
125 skcipher_walk_done(walk, walk->nbytes % AEGIS128L_BLOCK_SIZE);
126 }
127
128 if (walk->nbytes) {
129 ops->crypt_tail(state, walk->nbytes, walk->src.virt.addr,
130 walk->dst.virt.addr);
131 skcipher_walk_done(walk, 0);
132 }
133}
134
135static struct aegis_ctx *crypto_aegis128l_aesni_ctx(struct crypto_aead *aead)
136{
137 u8 *ctx = crypto_aead_ctx(aead);
138 ctx = PTR_ALIGN(ctx, __alignof__(struct aegis_ctx));
139 return (void *)ctx;
140}
141
142static int crypto_aegis128l_aesni_setkey(struct crypto_aead *aead,
143 const u8 *key, unsigned int keylen)
144{
145 struct aegis_ctx *ctx = crypto_aegis128l_aesni_ctx(aead);
146
147 if (keylen != AEGIS128L_KEY_SIZE) {
148 crypto_aead_set_flags(aead, CRYPTO_TFM_RES_BAD_KEY_LEN);
149 return -EINVAL;
150 }
151
152 memcpy(ctx->key.bytes, key, AEGIS128L_KEY_SIZE);
153
154 return 0;
155}
156
157static int crypto_aegis128l_aesni_setauthsize(struct crypto_aead *tfm,
158 unsigned int authsize)
159{
160 if (authsize > AEGIS128L_MAX_AUTH_SIZE)
161 return -EINVAL;
162 if (authsize < AEGIS128L_MIN_AUTH_SIZE)
163 return -EINVAL;
164 return 0;
165}
166
167static void crypto_aegis128l_aesni_crypt(struct aead_request *req,
168 struct aegis_block *tag_xor,
169 unsigned int cryptlen,
170 const struct aegis_crypt_ops *ops)
171{
172 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
173 struct aegis_ctx *ctx = crypto_aegis128l_aesni_ctx(tfm);
174 struct skcipher_walk walk;
175 struct aegis_state state;
176
177 ops->skcipher_walk_init(&walk, req, true);
178
179 kernel_fpu_begin();
180
181 crypto_aegis128l_aesni_init(&state, ctx->key.bytes, req->iv);
182 crypto_aegis128l_aesni_process_ad(&state, req->src, req->assoclen);
183 crypto_aegis128l_aesni_process_crypt(&state, &walk, ops);
184 crypto_aegis128l_aesni_final(&state, tag_xor, req->assoclen, cryptlen);
185
186 kernel_fpu_end();
187}
188
189static int crypto_aegis128l_aesni_encrypt(struct aead_request *req)
190{
191 static const struct aegis_crypt_ops OPS = {
192 .skcipher_walk_init = skcipher_walk_aead_encrypt,
193 .crypt_blocks = crypto_aegis128l_aesni_enc,
194 .crypt_tail = crypto_aegis128l_aesni_enc_tail,
195 };
196
197 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
198 struct aegis_block tag = {};
199 unsigned int authsize = crypto_aead_authsize(tfm);
200 unsigned int cryptlen = req->cryptlen;
201
202 crypto_aegis128l_aesni_crypt(req, &tag, cryptlen, &OPS);
203
204 scatterwalk_map_and_copy(tag.bytes, req->dst,
205 req->assoclen + cryptlen, authsize, 1);
206 return 0;
207}
208
209static int crypto_aegis128l_aesni_decrypt(struct aead_request *req)
210{
211 static const struct aegis_block zeros = {};
212
213 static const struct aegis_crypt_ops OPS = {
214 .skcipher_walk_init = skcipher_walk_aead_decrypt,
215 .crypt_blocks = crypto_aegis128l_aesni_dec,
216 .crypt_tail = crypto_aegis128l_aesni_dec_tail,
217 };
218
219 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
220 struct aegis_block tag;
221 unsigned int authsize = crypto_aead_authsize(tfm);
222 unsigned int cryptlen = req->cryptlen - authsize;
223
224 scatterwalk_map_and_copy(tag.bytes, req->src,
225 req->assoclen + cryptlen, authsize, 0);
226
227 crypto_aegis128l_aesni_crypt(req, &tag, cryptlen, &OPS);
228
229 return crypto_memneq(tag.bytes, zeros.bytes, authsize) ? -EBADMSG : 0;
230}
231
232static int crypto_aegis128l_aesni_init_tfm(struct crypto_aead *aead)
233{
234 return 0;
235}
236
237static void crypto_aegis128l_aesni_exit_tfm(struct crypto_aead *aead)
238{
239}
240
241static struct aead_alg crypto_aegis128l_aesni_alg = {
242 .setkey = crypto_aegis128l_aesni_setkey,
243 .setauthsize = crypto_aegis128l_aesni_setauthsize,
244 .encrypt = crypto_aegis128l_aesni_encrypt,
245 .decrypt = crypto_aegis128l_aesni_decrypt,
246 .init = crypto_aegis128l_aesni_init_tfm,
247 .exit = crypto_aegis128l_aesni_exit_tfm,
248
249 .ivsize = AEGIS128L_NONCE_SIZE,
250 .maxauthsize = AEGIS128L_MAX_AUTH_SIZE,
251 .chunksize = AEGIS128L_BLOCK_SIZE,
252
253 .base = {
254 .cra_flags = CRYPTO_ALG_INTERNAL,
255 .cra_blocksize = 1,
256 .cra_ctxsize = sizeof(struct aegis_ctx) +
257 __alignof__(struct aegis_ctx),
258 .cra_alignmask = 0,
259 .cra_priority = 400,
260
261 .cra_name = "__aegis128l",
262 .cra_driver_name = "__aegis128l-aesni",
263
264 .cra_module = THIS_MODULE,
265 }
266};
267
268static struct simd_aead_alg *simd_alg;
269
270static int __init crypto_aegis128l_aesni_module_init(void)
271{
272 if (!boot_cpu_has(X86_FEATURE_XMM2) ||
273 !boot_cpu_has(X86_FEATURE_AES) ||
274 !cpu_has_xfeatures(XFEATURE_MASK_SSE, NULL))
275 return -ENODEV;
276
277 return simd_register_aeads_compat(&crypto_aegis128l_aesni_alg, 1,
278 &simd_alg);
279}
280
281static void __exit crypto_aegis128l_aesni_module_exit(void)
282{
283 simd_unregister_aeads(&crypto_aegis128l_aesni_alg, 1, &simd_alg);
284}
285
286module_init(crypto_aegis128l_aesni_module_init);
287module_exit(crypto_aegis128l_aesni_module_exit);
288
289MODULE_LICENSE("GPL");
290MODULE_AUTHOR("Ondrej Mosnacek <omosnacek@gmail.com>");
291MODULE_DESCRIPTION("AEGIS-128L AEAD algorithm -- AESNI+SSE2 implementation");
292MODULE_ALIAS_CRYPTO("aegis128l");
293MODULE_ALIAS_CRYPTO("aegis128l-aesni");
294
