1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * The AEGIS-128 Authenticated-Encryption Algorithm
4  *   Glue for AES-NI + SSE2 implementation
5  *
6  * Copyright (c) 2017-2018 Ondrej Mosnacek <omosnacek@gmail.com>
7  * Copyright (C) 2017-2018 Red Hat, Inc. All rights reserved.
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 AEGIS128_BLOCK_ALIGN 16
19 #define AEGIS128_BLOCK_SIZE 16
20 #define AEGIS128_NONCE_SIZE 16
21 #define AEGIS128_STATE_BLOCKS 5
22 #define AEGIS128_KEY_SIZE 16
23 #define AEGIS128_MIN_AUTH_SIZE 8
24 #define AEGIS128_MAX_AUTH_SIZE 16
25 
26 asmlinkage void crypto_aegis128_aesni_init(void *state, void *key, void *iv);
27 
28 asmlinkage void crypto_aegis128_aesni_ad(
29 		void *state, unsigned int length, const void *data);
30 
31 asmlinkage void crypto_aegis128_aesni_enc(
32 		void *state, unsigned int length, const void *src, void *dst);
33 
34 asmlinkage void crypto_aegis128_aesni_dec(
35 		void *state, unsigned int length, const void *src, void *dst);
36 
37 asmlinkage void crypto_aegis128_aesni_enc_tail(
38 		void *state, unsigned int length, const void *src, void *dst);
39 
40 asmlinkage void crypto_aegis128_aesni_dec_tail(
41 		void *state, unsigned int length, const void *src, void *dst);
42 
43 asmlinkage void crypto_aegis128_aesni_final(
44 		void *state, void *tag_xor, unsigned int cryptlen,
45 		unsigned int assoclen);
46 
47 struct aegis_block {
48 	u8 bytes[AEGIS128_BLOCK_SIZE] __aligned(AEGIS128_BLOCK_ALIGN);
49 };
50 
51 struct aegis_state {
52 	struct aegis_block blocks[AEGIS128_STATE_BLOCKS];
53 };
54 
55 struct aegis_ctx {
56 	struct aegis_block key;
57 };
58 
59 struct 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 
69 static void crypto_aegis128_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 >= AEGIS128_BLOCK_SIZE) {
85 			if (pos > 0) {
86 				unsigned int fill = AEGIS128_BLOCK_SIZE - pos;
87 				memcpy(buf.bytes + pos, src, fill);
88 				crypto_aegis128_aesni_ad(state,
89 							 AEGIS128_BLOCK_SIZE,
90 							 buf.bytes);
91 				pos = 0;
92 				left -= fill;
93 				src += fill;
94 			}
95 
96 			crypto_aegis128_aesni_ad(state, left, src);
97 
98 			src += left & ~(AEGIS128_BLOCK_SIZE - 1);
99 			left &= AEGIS128_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, AEGIS128_BLOCK_SIZE - pos);
113 		crypto_aegis128_aesni_ad(state, AEGIS128_BLOCK_SIZE, buf.bytes);
114 	}
115 }
116 
117 static void crypto_aegis128_aesni_process_crypt(
118 		struct aegis_state *state, struct skcipher_walk *walk,
119 		const struct aegis_crypt_ops *ops)
120 {
121 	while (walk->nbytes >= AEGIS128_BLOCK_SIZE) {
122 		ops->crypt_blocks(state,
123 				  round_down(walk->nbytes, AEGIS128_BLOCK_SIZE),
124 				  walk->src.virt.addr, walk->dst.virt.addr);
125 		skcipher_walk_done(walk, walk->nbytes % AEGIS128_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 
135 static struct aegis_ctx *crypto_aegis128_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 
142 static int crypto_aegis128_aesni_setkey(struct crypto_aead *aead, const u8 *key,
143 					unsigned int keylen)
144 {
145 	struct aegis_ctx *ctx = crypto_aegis128_aesni_ctx(aead);
146 
147 	if (keylen != AEGIS128_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, AEGIS128_KEY_SIZE);
153 
154 	return 0;
155 }
156 
157 static int crypto_aegis128_aesni_setauthsize(struct crypto_aead *tfm,
158 						unsigned int authsize)
159 {
160 	if (authsize > AEGIS128_MAX_AUTH_SIZE)
161 		return -EINVAL;
162 	if (authsize < AEGIS128_MIN_AUTH_SIZE)
163 		return -EINVAL;
164 	return 0;
165 }
166 
167 static void crypto_aegis128_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_aegis128_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_aegis128_aesni_init(&state, ctx->key.bytes, req->iv);
182 	crypto_aegis128_aesni_process_ad(&state, req->src, req->assoclen);
183 	crypto_aegis128_aesni_process_crypt(&state, &walk, ops);
184 	crypto_aegis128_aesni_final(&state, tag_xor, req->assoclen, cryptlen);
185 
186 	kernel_fpu_end();
187 }
188 
189 static int crypto_aegis128_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_aegis128_aesni_enc,
194 		.crypt_tail = crypto_aegis128_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_aegis128_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 
209 static int crypto_aegis128_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_aegis128_aesni_dec,
216 		.crypt_tail = crypto_aegis128_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_aegis128_aesni_crypt(req, &tag, cryptlen, &OPS);
228 
229 	return crypto_memneq(tag.bytes, zeros.bytes, authsize) ? -EBADMSG : 0;
230 }
231 
232 static int crypto_aegis128_aesni_init_tfm(struct crypto_aead *aead)
233 {
234 	return 0;
235 }
236 
237 static void crypto_aegis128_aesni_exit_tfm(struct crypto_aead *aead)
238 {
239 }
240 
241 static struct aead_alg crypto_aegis128_aesni_alg = {
242 	.setkey = crypto_aegis128_aesni_setkey,
243 	.setauthsize = crypto_aegis128_aesni_setauthsize,
244 	.encrypt = crypto_aegis128_aesni_encrypt,
245 	.decrypt = crypto_aegis128_aesni_decrypt,
246 	.init = crypto_aegis128_aesni_init_tfm,
247 	.exit = crypto_aegis128_aesni_exit_tfm,
248 
249 	.ivsize = AEGIS128_NONCE_SIZE,
250 	.maxauthsize = AEGIS128_MAX_AUTH_SIZE,
251 	.chunksize = AEGIS128_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 = "__aegis128",
262 		.cra_driver_name = "__aegis128-aesni",
263 
264 		.cra_module = THIS_MODULE,
265 	}
266 };
267 
268 static struct simd_aead_alg *simd_alg;
269 
270 static int __init crypto_aegis128_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_aegis128_aesni_alg, 1,
278 					  &simd_alg);
279 }
280 
281 static void __exit crypto_aegis128_aesni_module_exit(void)
282 {
283 	simd_unregister_aeads(&crypto_aegis128_aesni_alg, 1, &simd_alg);
284 }
285 
286 module_init(crypto_aegis128_aesni_module_init);
287 module_exit(crypto_aegis128_aesni_module_exit);
288 
289 MODULE_LICENSE("GPL");
290 MODULE_AUTHOR("Ondrej Mosnacek <omosnacek@gmail.com>");
291 MODULE_DESCRIPTION("AEGIS-128 AEAD algorithm -- AESNI+SSE2 implementation");
292 MODULE_ALIAS_CRYPTO("aegis128");
293 MODULE_ALIAS_CRYPTO("aegis128-aesni");
294