aes_sse2_subr.c revision 1.3 1 1.3 riastrad /* $NetBSD: aes_sse2_subr.c,v 1.3 2020/07/25 22:29:56 riastradh Exp $ */
2 1.1 riastrad
3 1.1 riastrad /*-
4 1.1 riastrad * Copyright (c) 2020 The NetBSD Foundation, Inc.
5 1.1 riastrad * All rights reserved.
6 1.1 riastrad *
7 1.1 riastrad * Redistribution and use in source and binary forms, with or without
8 1.1 riastrad * modification, are permitted provided that the following conditions
9 1.1 riastrad * are met:
10 1.1 riastrad * 1. Redistributions of source code must retain the above copyright
11 1.1 riastrad * notice, this list of conditions and the following disclaimer.
12 1.1 riastrad * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 riastrad * notice, this list of conditions and the following disclaimer in the
14 1.1 riastrad * documentation and/or other materials provided with the distribution.
15 1.1 riastrad *
16 1.1 riastrad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 riastrad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 riastrad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 riastrad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 riastrad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 riastrad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 riastrad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 riastrad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 riastrad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 riastrad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 riastrad * POSSIBILITY OF SUCH DAMAGE.
27 1.1 riastrad */
28 1.1 riastrad
29 1.1 riastrad #include <sys/cdefs.h>
30 1.3 riastrad __KERNEL_RCSID(1, "$NetBSD: aes_sse2_subr.c,v 1.3 2020/07/25 22:29:56 riastradh Exp $");
31 1.1 riastrad
32 1.2 riastrad #ifdef _KERNEL
33 1.1 riastrad #include <sys/systm.h>
34 1.1 riastrad #include <lib/libkern/libkern.h>
35 1.2 riastrad #else
36 1.2 riastrad #include <err.h>
37 1.2 riastrad #include <assert.h>
38 1.2 riastrad #include <inttypes.h>
39 1.2 riastrad #include <stdio.h>
40 1.2 riastrad #include <string.h>
41 1.2 riastrad #define KASSERT assert
42 1.2 riastrad #define panic(fmt, args...) err(1, fmt, ##args)
43 1.2 riastrad #endif
44 1.1 riastrad
45 1.1 riastrad #include <crypto/aes/aes.h>
46 1.1 riastrad #include <crypto/aes/arch/x86/aes_sse2.h>
47 1.1 riastrad
48 1.1 riastrad #include "aes_sse2_impl.h"
49 1.1 riastrad
50 1.1 riastrad void
51 1.1 riastrad aes_sse2_setkey(uint64_t rk[static 30], const void *key, uint32_t nrounds)
52 1.1 riastrad {
53 1.1 riastrad size_t key_len;
54 1.1 riastrad
55 1.1 riastrad switch (nrounds) {
56 1.1 riastrad case 10:
57 1.1 riastrad key_len = 16;
58 1.1 riastrad break;
59 1.1 riastrad case 12:
60 1.1 riastrad key_len = 24;
61 1.1 riastrad break;
62 1.1 riastrad case 14:
63 1.1 riastrad key_len = 32;
64 1.1 riastrad break;
65 1.1 riastrad default:
66 1.1 riastrad panic("invalid AES nrounds: %u", nrounds);
67 1.1 riastrad }
68 1.1 riastrad
69 1.1 riastrad aes_sse2_keysched(rk, key, key_len);
70 1.1 riastrad }
71 1.1 riastrad
72 1.1 riastrad void
73 1.1 riastrad aes_sse2_enc(const struct aesenc *enc, const uint8_t in[static 16],
74 1.1 riastrad uint8_t out[static 16], uint32_t nrounds)
75 1.1 riastrad {
76 1.1 riastrad uint64_t sk_exp[120];
77 1.1 riastrad __m128i q[4];
78 1.1 riastrad
79 1.1 riastrad /* Expand round keys for bitslicing. */
80 1.1 riastrad aes_sse2_skey_expand(sk_exp, nrounds, enc->aese_aes.aes_rk64);
81 1.1 riastrad
82 1.1 riastrad /* Load input block interleaved with garbage blocks. */
83 1.1 riastrad q[0] = aes_sse2_interleave_in(_mm_loadu_epi8(in));
84 1.1 riastrad q[1] = q[2] = q[3] = _mm_setzero_si128();
85 1.1 riastrad
86 1.1 riastrad /* Transform to bitslice, decrypt, transform from bitslice. */
87 1.1 riastrad aes_sse2_ortho(q);
88 1.1 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
89 1.1 riastrad aes_sse2_ortho(q);
90 1.1 riastrad
91 1.1 riastrad /* Store output block. */
92 1.1 riastrad _mm_storeu_epi8(out, aes_sse2_interleave_out(q[0]));
93 1.1 riastrad
94 1.1 riastrad /* Paranoia: Zero temporary buffers. */
95 1.1 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
96 1.1 riastrad explicit_memset(q, 0, sizeof q);
97 1.1 riastrad }
98 1.1 riastrad
99 1.1 riastrad void
100 1.1 riastrad aes_sse2_dec(const struct aesdec *dec, const uint8_t in[static 16],
101 1.1 riastrad uint8_t out[static 16], uint32_t nrounds)
102 1.1 riastrad {
103 1.1 riastrad uint64_t sk_exp[120];
104 1.1 riastrad __m128i q[4];
105 1.1 riastrad
106 1.1 riastrad /* Expand round keys for bitslicing. */
107 1.1 riastrad aes_sse2_skey_expand(sk_exp, nrounds, dec->aesd_aes.aes_rk64);
108 1.1 riastrad
109 1.1 riastrad /* Load input block interleaved with garbage blocks. */
110 1.1 riastrad q[0] = aes_sse2_interleave_in(_mm_loadu_epi8(in));
111 1.1 riastrad q[1] = q[2] = q[3] = _mm_setzero_si128();
112 1.1 riastrad
113 1.1 riastrad /* Transform to bitslice, decrypt, transform from bitslice. */
114 1.1 riastrad aes_sse2_ortho(q);
115 1.1 riastrad aes_sse2_bitslice_decrypt(nrounds, sk_exp, q);
116 1.1 riastrad aes_sse2_ortho(q);
117 1.1 riastrad
118 1.1 riastrad /* Store output block. */
119 1.1 riastrad _mm_storeu_epi8(out, aes_sse2_interleave_out(q[0]));
120 1.1 riastrad
121 1.1 riastrad /* Paranoia: Zero temporary buffers. */
122 1.1 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
123 1.1 riastrad explicit_memset(q, 0, sizeof q);
124 1.1 riastrad }
125 1.1 riastrad
126 1.1 riastrad void
127 1.1 riastrad aes_sse2_cbc_enc(const struct aesenc *enc, const uint8_t in[static 16],
128 1.1 riastrad uint8_t out[static 16], size_t nbytes, uint8_t iv[static 16],
129 1.1 riastrad uint32_t nrounds)
130 1.1 riastrad {
131 1.1 riastrad uint64_t sk_exp[120];
132 1.1 riastrad __m128i q[4];
133 1.1 riastrad __m128i cv;
134 1.1 riastrad
135 1.1 riastrad KASSERT(nbytes);
136 1.1 riastrad KASSERT(nbytes % 16 == 0);
137 1.1 riastrad
138 1.1 riastrad /* Expand round keys for bitslicing. */
139 1.1 riastrad aes_sse2_skey_expand(sk_exp, nrounds, enc->aese_aes.aes_rk64);
140 1.1 riastrad
141 1.1 riastrad /* Load the IV. */
142 1.1 riastrad cv = _mm_loadu_epi8(iv);
143 1.1 riastrad
144 1.1 riastrad for (; nbytes; nbytes -= 16, in += 16, out += 16) {
145 1.1 riastrad /* Load input block and apply CV. */
146 1.1 riastrad q[0] = aes_sse2_interleave_in(cv ^ _mm_loadu_epi8(in));
147 1.1 riastrad
148 1.1 riastrad /* Transform to bitslice, encrypt, transform from bitslice. */
149 1.1 riastrad aes_sse2_ortho(q);
150 1.1 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
151 1.1 riastrad aes_sse2_ortho(q);
152 1.1 riastrad
153 1.1 riastrad /* Remember ciphertext as CV and store output block. */
154 1.1 riastrad cv = aes_sse2_interleave_out(q[0]);
155 1.1 riastrad _mm_storeu_epi8(out, cv);
156 1.1 riastrad }
157 1.1 riastrad
158 1.1 riastrad /* Store updated IV. */
159 1.1 riastrad _mm_storeu_epi8(iv, cv);
160 1.1 riastrad
161 1.1 riastrad /* Paranoia: Zero temporary buffers. */
162 1.1 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
163 1.1 riastrad explicit_memset(q, 0, sizeof q);
164 1.1 riastrad }
165 1.1 riastrad
166 1.1 riastrad void
167 1.1 riastrad aes_sse2_cbc_dec(const struct aesdec *dec, const uint8_t in[static 16],
168 1.1 riastrad uint8_t out[static 16], size_t nbytes, uint8_t ivp[static 16],
169 1.1 riastrad uint32_t nrounds)
170 1.1 riastrad {
171 1.1 riastrad uint64_t sk_exp[120];
172 1.1 riastrad __m128i q[4];
173 1.1 riastrad __m128i cv, iv, w;
174 1.1 riastrad
175 1.1 riastrad KASSERT(nbytes);
176 1.1 riastrad KASSERT(nbytes % 16 == 0);
177 1.1 riastrad
178 1.1 riastrad /* Expand round keys for bitslicing. */
179 1.1 riastrad aes_sse2_skey_expand(sk_exp, nrounds, dec->aesd_aes.aes_rk64);
180 1.1 riastrad
181 1.1 riastrad /* Load the IV. */
182 1.1 riastrad iv = _mm_loadu_epi8(ivp);
183 1.1 riastrad
184 1.1 riastrad /* Load the last cipher block. */
185 1.1 riastrad cv = _mm_loadu_epi8(in + nbytes - 16);
186 1.1 riastrad
187 1.1 riastrad /* Store the updated IV. */
188 1.1 riastrad _mm_storeu_epi8(ivp, cv);
189 1.1 riastrad
190 1.1 riastrad /* Process the last blocks if not an even multiple of four. */
191 1.1 riastrad if (nbytes % (4*16)) {
192 1.1 riastrad unsigned n = (nbytes/16) % 4;
193 1.1 riastrad
194 1.1 riastrad KASSERT(n > 0);
195 1.1 riastrad KASSERT(n < 4);
196 1.1 riastrad
197 1.1 riastrad q[1] = q[2] = q[3] = _mm_setzero_si128();
198 1.1 riastrad q[n - 1] = aes_sse2_interleave_in(cv);
199 1.1 riastrad switch (nbytes % 64) {
200 1.1 riastrad case 48:
201 1.1 riastrad w = _mm_loadu_epi8(in + nbytes - 32);
202 1.1 riastrad q[1] = aes_sse2_interleave_in(w);
203 1.1 riastrad /*FALLTHROUGH*/
204 1.1 riastrad case 32:
205 1.1 riastrad w = _mm_loadu_epi8(in + nbytes - 48);
206 1.1 riastrad q[0] = aes_sse2_interleave_in(w);
207 1.1 riastrad /*FALLTHROUGH*/
208 1.1 riastrad case 16:
209 1.1 riastrad break;
210 1.1 riastrad }
211 1.1 riastrad
212 1.1 riastrad /* Decrypt. */
213 1.1 riastrad aes_sse2_ortho(q);
214 1.1 riastrad aes_sse2_bitslice_decrypt(nrounds, sk_exp, q);
215 1.1 riastrad aes_sse2_ortho(q);
216 1.1 riastrad
217 1.1 riastrad do {
218 1.1 riastrad n--;
219 1.1 riastrad w = aes_sse2_interleave_out(q[n]);
220 1.1 riastrad if ((nbytes -= 16) == 0)
221 1.1 riastrad goto out;
222 1.1 riastrad cv = _mm_loadu_epi8(in + nbytes - 16);
223 1.1 riastrad _mm_storeu_epi8(out + nbytes, w ^ cv);
224 1.1 riastrad } while (n);
225 1.1 riastrad }
226 1.1 riastrad
227 1.1 riastrad for (;;) {
228 1.1 riastrad KASSERT(nbytes >= 64);
229 1.1 riastrad nbytes -= 64;
230 1.1 riastrad
231 1.1 riastrad /*
232 1.1 riastrad * 1. Set up upper cipher block from cv.
233 1.1 riastrad * 2. Load lower cipher block into cv and set it up.
234 1.1 riastrad * 3. Decrypt.
235 1.1 riastrad */
236 1.1 riastrad q[3] = aes_sse2_interleave_in(cv);
237 1.1 riastrad
238 1.1 riastrad w = _mm_loadu_epi8(in + nbytes + 4*8);
239 1.1 riastrad q[2] = aes_sse2_interleave_in(w);
240 1.1 riastrad
241 1.1 riastrad w = _mm_loadu_epi8(in + nbytes + 4*4);
242 1.1 riastrad q[1] = aes_sse2_interleave_in(w);
243 1.1 riastrad
244 1.1 riastrad w = _mm_loadu_epi8(in + nbytes + 4*0);
245 1.1 riastrad q[0] = aes_sse2_interleave_in(w);
246 1.1 riastrad
247 1.1 riastrad aes_sse2_ortho(q);
248 1.1 riastrad aes_sse2_bitslice_decrypt(nrounds, sk_exp, q);
249 1.1 riastrad aes_sse2_ortho(q);
250 1.1 riastrad
251 1.1 riastrad /* Store the upper output block. */
252 1.1 riastrad w = aes_sse2_interleave_out(q[3]);
253 1.1 riastrad cv = _mm_loadu_epi8(in + nbytes + 4*8);
254 1.1 riastrad _mm_storeu_epi8(out + nbytes + 4*12, w ^ cv);
255 1.1 riastrad
256 1.1 riastrad /* Store the middle output blocks. */
257 1.1 riastrad w = aes_sse2_interleave_out(q[2]);
258 1.1 riastrad cv = _mm_loadu_epi8(in + nbytes + 4*4);
259 1.1 riastrad _mm_storeu_epi8(out + nbytes + 4*8, w ^ cv);
260 1.1 riastrad
261 1.1 riastrad w = aes_sse2_interleave_out(q[1]);
262 1.1 riastrad cv = _mm_loadu_epi8(in + nbytes + 4*0);
263 1.1 riastrad _mm_storeu_epi8(out + nbytes + 4*4, w ^ cv);
264 1.1 riastrad
265 1.1 riastrad /*
266 1.1 riastrad * Get the first output block, but don't load the CV
267 1.1 riastrad * yet -- it might be the previous ciphertext block, or
268 1.1 riastrad * it might be the IV.
269 1.1 riastrad */
270 1.1 riastrad w = aes_sse2_interleave_out(q[0]);
271 1.1 riastrad
272 1.1 riastrad /* Stop if we've reached the first output block. */
273 1.1 riastrad if (nbytes == 0)
274 1.1 riastrad goto out;
275 1.1 riastrad
276 1.1 riastrad /*
277 1.1 riastrad * Load the preceding cipher block, and apply it as the
278 1.1 riastrad * chaining value to this one.
279 1.1 riastrad */
280 1.1 riastrad cv = _mm_loadu_epi8(in + nbytes - 16);
281 1.1 riastrad _mm_storeu_epi8(out + nbytes, w ^ cv);
282 1.1 riastrad }
283 1.1 riastrad
284 1.1 riastrad out: /* Store the first output block. */
285 1.1 riastrad _mm_storeu_epi8(out, w ^ iv);
286 1.1 riastrad
287 1.1 riastrad /* Paranoia: Zero temporary buffers. */
288 1.1 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
289 1.1 riastrad explicit_memset(q, 0, sizeof q);
290 1.1 riastrad }
291 1.1 riastrad
292 1.1 riastrad static inline __m128i
293 1.1 riastrad aes_sse2_xts_update(__m128i t)
294 1.1 riastrad {
295 1.1 riastrad const __m128i one = _mm_set_epi64x(1, 1);
296 1.1 riastrad __m128i s, m, c;
297 1.1 riastrad
298 1.1 riastrad s = _mm_srli_epi64(t, 63); /* 1 if high bit set else 0 */
299 1.1 riastrad m = _mm_sub_epi64(s, one); /* 0 if high bit set else -1 */
300 1.1 riastrad m = _mm_shuffle_epi32(m, 0x4e); /* swap halves */
301 1.1 riastrad c = _mm_set_epi64x(1, 0x87); /* carry */
302 1.1 riastrad
303 1.1 riastrad return _mm_slli_epi64(t, 1) ^ (c & ~m);
304 1.1 riastrad }
305 1.1 riastrad
306 1.1 riastrad static int
307 1.1 riastrad aes_sse2_xts_update_selftest(void)
308 1.1 riastrad {
309 1.1 riastrad static const struct {
310 1.1 riastrad uint32_t in[4], out[4];
311 1.1 riastrad } cases[] = {
312 1.1 riastrad [0] = { {1}, {2} },
313 1.1 riastrad [1] = { {0x80000000U,0,0,0}, {0,1,0,0} },
314 1.1 riastrad [2] = { {0,0x80000000U,0,0}, {0,0,1,0} },
315 1.1 riastrad [3] = { {0,0,0x80000000U,0}, {0,0,0,1} },
316 1.1 riastrad [4] = { {0,0,0,0x80000000U}, {0x87,0,0,0} },
317 1.1 riastrad [5] = { {0,0x80000000U,0,0x80000000U}, {0x87,0,1,0} },
318 1.1 riastrad };
319 1.1 riastrad unsigned i;
320 1.1 riastrad uint32_t t[4];
321 1.1 riastrad int result = 0;
322 1.1 riastrad
323 1.1 riastrad for (i = 0; i < sizeof(cases)/sizeof(cases[0]); i++) {
324 1.1 riastrad t[0] = cases[i].in[0];
325 1.1 riastrad t[1] = cases[i].in[1];
326 1.1 riastrad t[2] = cases[i].in[2];
327 1.1 riastrad t[3] = cases[i].in[3];
328 1.1 riastrad _mm_storeu_epi8(t, aes_sse2_xts_update(_mm_loadu_epi8(t)));
329 1.1 riastrad if (t[0] != cases[i].out[0] ||
330 1.1 riastrad t[1] != cases[i].out[1] ||
331 1.1 riastrad t[2] != cases[i].out[2] ||
332 1.1 riastrad t[3] != cases[i].out[3]) {
333 1.1 riastrad printf("%s %u:"
334 1.1 riastrad " %"PRIx32" %"PRIx32" %"PRIx32" %"PRIx32"\n",
335 1.1 riastrad __func__, i, t[0], t[1], t[2], t[3]);
336 1.1 riastrad result = -1;
337 1.1 riastrad }
338 1.1 riastrad }
339 1.1 riastrad
340 1.1 riastrad return result;
341 1.1 riastrad }
342 1.1 riastrad
343 1.1 riastrad void
344 1.1 riastrad aes_sse2_xts_enc(const struct aesenc *enc, const uint8_t in[static 16],
345 1.1 riastrad uint8_t out[static 16], size_t nbytes, uint8_t tweak[static 16],
346 1.1 riastrad uint32_t nrounds)
347 1.1 riastrad {
348 1.1 riastrad uint64_t sk_exp[120];
349 1.1 riastrad __m128i q[4];
350 1.1 riastrad __m128i w;
351 1.1 riastrad __m128i t[5];
352 1.1 riastrad unsigned i;
353 1.1 riastrad
354 1.1 riastrad KASSERT(nbytes);
355 1.1 riastrad KASSERT(nbytes % 16 == 0);
356 1.1 riastrad
357 1.1 riastrad /* Expand round keys for bitslicing. */
358 1.1 riastrad aes_sse2_skey_expand(sk_exp, nrounds, enc->aese_aes.aes_rk64);
359 1.1 riastrad
360 1.1 riastrad /* Load tweak. */
361 1.1 riastrad t[0] = _mm_loadu_epi8(tweak);
362 1.1 riastrad
363 1.1 riastrad /* Handle the first block separately if odd number. */
364 1.1 riastrad if (nbytes % (4*16)) {
365 1.1 riastrad /* Load up the tweaked inputs. */
366 1.1 riastrad for (i = 0; i < (nbytes/16) % 4; i++) {
367 1.1 riastrad w = _mm_loadu_epi8(in + 16*i) ^ t[i];
368 1.1 riastrad q[i] = aes_sse2_interleave_in(w);
369 1.1 riastrad t[i + 1] = aes_sse2_xts_update(t[i]);
370 1.1 riastrad }
371 1.1 riastrad for (; i < 4; i++)
372 1.1 riastrad q[i] = _mm_setzero_si128();
373 1.1 riastrad
374 1.1 riastrad /* Encrypt up to four blocks. */
375 1.1 riastrad aes_sse2_ortho(q);
376 1.1 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
377 1.1 riastrad aes_sse2_ortho(q);
378 1.1 riastrad
379 1.1 riastrad /* Store the tweaked outputs. */
380 1.1 riastrad for (i = 0; i < (nbytes/16) % 4; i++) {
381 1.1 riastrad w = aes_sse2_interleave_out(q[i]);
382 1.1 riastrad _mm_storeu_epi8(out + 16*i, w ^ t[i]);
383 1.1 riastrad }
384 1.1 riastrad
385 1.1 riastrad /* Advance to the next block. */
386 1.1 riastrad t[0] = t[i];
387 1.1 riastrad in += nbytes % (4*16);
388 1.1 riastrad out += nbytes % (4*16);
389 1.1 riastrad nbytes -= nbytes % (4*16);
390 1.1 riastrad if (nbytes == 0)
391 1.1 riastrad goto out;
392 1.1 riastrad }
393 1.1 riastrad
394 1.1 riastrad do {
395 1.1 riastrad KASSERT(nbytes % 64 == 0);
396 1.1 riastrad KASSERT(nbytes >= 64);
397 1.1 riastrad
398 1.1 riastrad /* Load up the tweaked inputs. */
399 1.1 riastrad for (i = 0; i < 4; i++) {
400 1.1 riastrad w = _mm_loadu_epi8(in + 16*i) ^ t[i];
401 1.1 riastrad q[i] = aes_sse2_interleave_in(w);
402 1.1 riastrad t[i + 1] = aes_sse2_xts_update(t[i]);
403 1.1 riastrad }
404 1.1 riastrad
405 1.1 riastrad /* Encrypt four blocks. */
406 1.1 riastrad aes_sse2_ortho(q);
407 1.1 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
408 1.1 riastrad aes_sse2_ortho(q);
409 1.1 riastrad
410 1.1 riastrad /* Store the tweaked outputs. */
411 1.1 riastrad for (i = 0; i < 4; i++) {
412 1.1 riastrad w = aes_sse2_interleave_out(q[i]);
413 1.1 riastrad _mm_storeu_epi8(out + 16*i, w ^ t[i]);
414 1.1 riastrad }
415 1.1 riastrad
416 1.1 riastrad /* Advance to the next block. */
417 1.1 riastrad t[0] = t[4];
418 1.1 riastrad in += 64;
419 1.1 riastrad out += 64;
420 1.1 riastrad nbytes -= 64;
421 1.1 riastrad } while (nbytes);
422 1.1 riastrad
423 1.1 riastrad out: /* Store the updated tweak. */
424 1.1 riastrad _mm_storeu_epi8(tweak, t[0]);
425 1.1 riastrad
426 1.1 riastrad /* Paranoia: Zero temporary buffers. */
427 1.1 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
428 1.1 riastrad explicit_memset(q, 0, sizeof q);
429 1.1 riastrad explicit_memset(t, 0, sizeof t);
430 1.1 riastrad }
431 1.1 riastrad
432 1.1 riastrad void
433 1.1 riastrad aes_sse2_xts_dec(const struct aesdec *dec, const uint8_t in[static 16],
434 1.1 riastrad uint8_t out[static 16], size_t nbytes, uint8_t tweak[static 16],
435 1.1 riastrad uint32_t nrounds)
436 1.1 riastrad {
437 1.1 riastrad uint64_t sk_exp[120];
438 1.1 riastrad __m128i q[4];
439 1.1 riastrad __m128i w;
440 1.1 riastrad __m128i t[5];
441 1.1 riastrad unsigned i;
442 1.1 riastrad
443 1.1 riastrad KASSERT(nbytes);
444 1.1 riastrad KASSERT(nbytes % 16 == 0);
445 1.1 riastrad
446 1.1 riastrad /* Expand round keys for bitslicing. */
447 1.1 riastrad aes_sse2_skey_expand(sk_exp, nrounds, dec->aesd_aes.aes_rk64);
448 1.1 riastrad
449 1.1 riastrad /* Load tweak. */
450 1.1 riastrad t[0] = _mm_loadu_epi8(tweak);
451 1.1 riastrad
452 1.1 riastrad /* Handle the first block separately if odd number. */
453 1.1 riastrad if (nbytes % (4*16)) {
454 1.1 riastrad /* Load up the tweaked inputs. */
455 1.1 riastrad for (i = 0; i < (nbytes/16) % 4; i++) {
456 1.1 riastrad w = _mm_loadu_epi8(in + 16*i) ^ t[i];
457 1.1 riastrad q[i] = aes_sse2_interleave_in(w);
458 1.1 riastrad t[i + 1] = aes_sse2_xts_update(t[i]);
459 1.1 riastrad }
460 1.1 riastrad for (; i < 4; i++)
461 1.1 riastrad q[i] = _mm_setzero_si128();
462 1.1 riastrad
463 1.1 riastrad /* Decrypt up to four blocks. */
464 1.1 riastrad aes_sse2_ortho(q);
465 1.1 riastrad aes_sse2_bitslice_decrypt(nrounds, sk_exp, q);
466 1.1 riastrad aes_sse2_ortho(q);
467 1.1 riastrad
468 1.1 riastrad /* Store the tweaked outputs. */
469 1.1 riastrad for (i = 0; i < (nbytes/16) % 4; i++) {
470 1.1 riastrad w = aes_sse2_interleave_out(q[i]);
471 1.1 riastrad _mm_storeu_epi8(out + 16*i, w ^ t[i]);
472 1.1 riastrad }
473 1.1 riastrad
474 1.1 riastrad /* Advance to the next block. */
475 1.1 riastrad t[0] = t[i];
476 1.1 riastrad in += nbytes % (4*16);
477 1.1 riastrad out += nbytes % (4*16);
478 1.1 riastrad nbytes -= nbytes % (4*16);
479 1.1 riastrad if (nbytes == 0)
480 1.1 riastrad goto out;
481 1.1 riastrad }
482 1.1 riastrad
483 1.1 riastrad do {
484 1.1 riastrad KASSERT(nbytes % 64 == 0);
485 1.1 riastrad KASSERT(nbytes >= 64);
486 1.1 riastrad
487 1.1 riastrad /* Load up the tweaked inputs. */
488 1.1 riastrad for (i = 0; i < 4; i++) {
489 1.1 riastrad w = _mm_loadu_epi8(in + 16*i) ^ t[i];
490 1.1 riastrad q[i] = aes_sse2_interleave_in(w);
491 1.1 riastrad t[i + 1] = aes_sse2_xts_update(t[i]);
492 1.1 riastrad }
493 1.1 riastrad
494 1.1 riastrad /* Decrypt four blocks. */
495 1.1 riastrad aes_sse2_ortho(q);
496 1.1 riastrad aes_sse2_bitslice_decrypt(nrounds, sk_exp, q);
497 1.1 riastrad aes_sse2_ortho(q);
498 1.1 riastrad
499 1.1 riastrad /* Store the tweaked outputs. */
500 1.1 riastrad for (i = 0; i < 4; i++) {
501 1.1 riastrad w = aes_sse2_interleave_out(q[i]);
502 1.1 riastrad _mm_storeu_epi8(out + 16*i, w ^ t[i]);
503 1.1 riastrad }
504 1.1 riastrad
505 1.1 riastrad /* Advance to the next block. */
506 1.1 riastrad t[0] = t[4];
507 1.1 riastrad in += 64;
508 1.1 riastrad out += 64;
509 1.1 riastrad nbytes -= 64;
510 1.1 riastrad } while (nbytes);
511 1.1 riastrad
512 1.1 riastrad out: /* Store the updated tweak. */
513 1.1 riastrad _mm_storeu_epi8(tweak, t[0]);
514 1.1 riastrad
515 1.1 riastrad /* Paranoia: Zero temporary buffers. */
516 1.1 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
517 1.1 riastrad explicit_memset(q, 0, sizeof q);
518 1.1 riastrad explicit_memset(t, 0, sizeof t);
519 1.1 riastrad }
520 1.1 riastrad
521 1.3 riastrad void
522 1.3 riastrad aes_sse2_cbcmac_update1(const struct aesenc *enc, const uint8_t in[static 16],
523 1.3 riastrad size_t nbytes, uint8_t auth[static 16], uint32_t nrounds)
524 1.3 riastrad {
525 1.3 riastrad uint64_t sk_exp[120];
526 1.3 riastrad __m128i q[4];
527 1.3 riastrad
528 1.3 riastrad KASSERT(nbytes);
529 1.3 riastrad KASSERT(nbytes % 16 == 0);
530 1.3 riastrad
531 1.3 riastrad /* Expand round keys for bitslicing. */
532 1.3 riastrad aes_sse2_skey_expand(sk_exp, nrounds, enc->aese_aes.aes_rk64);
533 1.3 riastrad
534 1.3 riastrad /* Load initial authenticator. */
535 1.3 riastrad q[0] = aes_sse2_interleave_in(_mm_loadu_epi8(auth));
536 1.3 riastrad
537 1.3 riastrad for (; nbytes; nbytes -= 16, in += 16) {
538 1.3 riastrad q[0] ^= aes_sse2_interleave_in(_mm_loadu_epi8(in));
539 1.3 riastrad aes_sse2_ortho(q);
540 1.3 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
541 1.3 riastrad aes_sse2_ortho(q);
542 1.3 riastrad }
543 1.3 riastrad
544 1.3 riastrad /* Store updated authenticator. */
545 1.3 riastrad _mm_storeu_epi8(auth, aes_sse2_interleave_out(q[0]));
546 1.3 riastrad
547 1.3 riastrad /* Paranoia: Zero temporary buffers. */
548 1.3 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
549 1.3 riastrad explicit_memset(q, 0, sizeof q);
550 1.3 riastrad }
551 1.3 riastrad
552 1.3 riastrad void
553 1.3 riastrad aes_sse2_ccm_enc1(const struct aesenc *enc, const uint8_t in[static 16],
554 1.3 riastrad uint8_t out[static 16], size_t nbytes, uint8_t authctr[static 32],
555 1.3 riastrad uint32_t nrounds)
556 1.3 riastrad {
557 1.3 riastrad uint64_t sk_exp[120];
558 1.3 riastrad __m128i q[4];
559 1.3 riastrad __m128i ctr;
560 1.3 riastrad uint32_t c0, c1, c2, c3;
561 1.3 riastrad
562 1.3 riastrad KASSERT(nbytes);
563 1.3 riastrad KASSERT(nbytes % 16 == 0);
564 1.3 riastrad
565 1.3 riastrad /* Expand round keys for bitslicing. */
566 1.3 riastrad aes_sse2_skey_expand(sk_exp, nrounds, enc->aese_aes.aes_rk64);
567 1.3 riastrad
568 1.3 riastrad /* Set first block to authenticator. */
569 1.3 riastrad q[0] = aes_sse2_interleave_in(_mm_loadu_epi8(authctr));
570 1.3 riastrad
571 1.3 riastrad /* Load initial counter block, big-endian so we can increment it. */
572 1.3 riastrad c0 = le32dec(authctr + 16 + 4*0);
573 1.3 riastrad c1 = le32dec(authctr + 16 + 4*1);
574 1.3 riastrad c2 = le32dec(authctr + 16 + 4*2);
575 1.3 riastrad c3 = be32dec(authctr + 16 + 4*3);
576 1.3 riastrad
577 1.3 riastrad /* Set other blocks to garbage -- can't take advantage. */
578 1.3 riastrad q[2] = q[3] = _mm_setzero_si128();
579 1.3 riastrad
580 1.3 riastrad for (; nbytes; nbytes -= 16, in += 16, out += 16) {
581 1.3 riastrad /* Update authenticator. */
582 1.3 riastrad q[0] ^= aes_sse2_interleave_in(_mm_loadu_epi8(in));
583 1.3 riastrad
584 1.3 riastrad /* Increment 32-bit counter. */
585 1.3 riastrad ctr = _mm_set_epi32(bswap32(++c3), c2, c1, c0);
586 1.3 riastrad q[1] = aes_sse2_interleave_in(ctr);
587 1.3 riastrad
588 1.3 riastrad /* Encrypt authenticator and counter. */
589 1.3 riastrad aes_sse2_ortho(q);
590 1.3 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
591 1.3 riastrad aes_sse2_ortho(q);
592 1.3 riastrad
593 1.3 riastrad /* Encrypt with CTR output. */
594 1.3 riastrad _mm_storeu_epi8(out,
595 1.3 riastrad _mm_loadu_epi8(in) ^ aes_sse2_interleave_out(q[1]));
596 1.3 riastrad }
597 1.3 riastrad
598 1.3 riastrad /* Update authenticator. */
599 1.3 riastrad _mm_storeu_epi8(authctr, aes_sse2_interleave_out(q[0]));
600 1.3 riastrad
601 1.3 riastrad /* Update counter. */
602 1.3 riastrad be32enc(authctr + 16 + 4*3, c3);
603 1.3 riastrad
604 1.3 riastrad /* Paranoia: Zero temporary buffers. */
605 1.3 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
606 1.3 riastrad explicit_memset(q, 0, sizeof q);
607 1.3 riastrad }
608 1.3 riastrad
609 1.3 riastrad void
610 1.3 riastrad aes_sse2_ccm_dec1(const struct aesenc *enc, const uint8_t in[static 16],
611 1.3 riastrad uint8_t out[static 16], size_t nbytes, uint8_t authctr[static 32],
612 1.3 riastrad uint32_t nrounds)
613 1.3 riastrad {
614 1.3 riastrad uint64_t sk_exp[120];
615 1.3 riastrad __m128i q[4];
616 1.3 riastrad __m128i ctr, block;
617 1.3 riastrad uint32_t c0, c1, c2, c3;
618 1.3 riastrad
619 1.3 riastrad KASSERT(nbytes);
620 1.3 riastrad KASSERT(nbytes % 16 == 0);
621 1.3 riastrad
622 1.3 riastrad /* Expand round keys for bitslicing. */
623 1.3 riastrad aes_sse2_skey_expand(sk_exp, nrounds, enc->aese_aes.aes_rk64);
624 1.3 riastrad
625 1.3 riastrad /* Load initial counter block, big-endian so we can increment it. */
626 1.3 riastrad c0 = le32dec(authctr + 16 + 4*0);
627 1.3 riastrad c1 = le32dec(authctr + 16 + 4*1);
628 1.3 riastrad c2 = le32dec(authctr + 16 + 4*2);
629 1.3 riastrad c3 = be32dec(authctr + 16 + 4*3);
630 1.3 riastrad
631 1.3 riastrad /* Increment 32-bit counter. */
632 1.3 riastrad ctr = _mm_set_epi32(bswap32(++c3), c2, c1, c0);
633 1.3 riastrad q[0] = aes_sse2_interleave_in(ctr);
634 1.3 riastrad
635 1.3 riastrad /*
636 1.3 riastrad * Set the other blocks to garbage -- we don't have any
637 1.3 riastrad * plaintext to authenticate yet.
638 1.3 riastrad */
639 1.3 riastrad q[1] = q[2] = q[3] = _mm_setzero_si128();
640 1.3 riastrad
641 1.3 riastrad /* Encrypt first CTR. */
642 1.3 riastrad aes_sse2_ortho(q);
643 1.3 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
644 1.3 riastrad aes_sse2_ortho(q);
645 1.3 riastrad
646 1.3 riastrad /* Load the initial authenticator. */
647 1.3 riastrad q[1] = aes_sse2_interleave_in(_mm_loadu_epi8(authctr));
648 1.3 riastrad
649 1.3 riastrad for (;; in += 16, out += 16) {
650 1.3 riastrad /* Decrypt the block. */
651 1.3 riastrad block = _mm_loadu_epi8(in) ^ aes_sse2_interleave_out(q[0]);
652 1.3 riastrad
653 1.3 riastrad /* Update authenticator. */
654 1.3 riastrad q[1] ^= aes_sse2_interleave_in(block);
655 1.3 riastrad
656 1.3 riastrad /* Store plaintext. */
657 1.3 riastrad _mm_storeu_epi8(out, block);
658 1.3 riastrad
659 1.3 riastrad /* If this is the last block, stop. */
660 1.3 riastrad if ((nbytes -= 16) == 0)
661 1.3 riastrad break;
662 1.3 riastrad
663 1.3 riastrad /* Increment 32-bit counter. */
664 1.3 riastrad ctr = _mm_set_epi32(bswap32(++c3), c2, c1, c0);
665 1.3 riastrad q[0] = aes_sse2_interleave_in(ctr);
666 1.3 riastrad
667 1.3 riastrad /* Authenticate previous plaintext, encrypt next CTR. */
668 1.3 riastrad aes_sse2_ortho(q);
669 1.3 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
670 1.3 riastrad aes_sse2_ortho(q);
671 1.3 riastrad }
672 1.3 riastrad
673 1.3 riastrad /*
674 1.3 riastrad * Authenticate last plaintext. We're only doing this for the
675 1.3 riastrad * authenticator, not for the counter, so don't bother to
676 1.3 riastrad * initialize q[0], q[2], q[3]. (Even for the sake of
677 1.3 riastrad * sanitizers, they're already initialized to something by
678 1.3 riastrad * now.)
679 1.3 riastrad */
680 1.3 riastrad aes_sse2_ortho(q);
681 1.3 riastrad aes_sse2_bitslice_encrypt(nrounds, sk_exp, q);
682 1.3 riastrad aes_sse2_ortho(q);
683 1.3 riastrad
684 1.3 riastrad /* Update authenticator. */
685 1.3 riastrad _mm_storeu_epi8(authctr, aes_sse2_interleave_out(q[1]));
686 1.3 riastrad
687 1.3 riastrad /* Update counter. */
688 1.3 riastrad be32enc(authctr + 16 + 4*3, c3);
689 1.3 riastrad
690 1.3 riastrad /* Paranoia: Zero temporary buffers. */
691 1.3 riastrad explicit_memset(sk_exp, 0, sizeof sk_exp);
692 1.3 riastrad explicit_memset(q, 0, sizeof q);
693 1.3 riastrad }
694 1.3 riastrad
695 1.1 riastrad int
696 1.1 riastrad aes_sse2_selftest(void)
697 1.1 riastrad {
698 1.1 riastrad
699 1.1 riastrad if (aes_sse2_xts_update_selftest())
700 1.1 riastrad return -1;
701 1.1 riastrad
702 1.1 riastrad /* XXX test aes_sse2_bitslice_decrypt */
703 1.1 riastrad /* XXX test aes_sse2_bitslice_encrypt */
704 1.1 riastrad /* XXX test aes_sse2_keysched */
705 1.1 riastrad /* XXX test aes_sse2_ortho */
706 1.1 riastrad /* XXX test aes_sse2_skey_expand */
707 1.1 riastrad
708 1.1 riastrad return 0;
709 1.1 riastrad }
710