scsi: esp: check buffer length before reading scsi command
[qemu/ar7.git] / crypto / cipher-nettle.c
blob70909fb7fea3f90e19a1e28983d7994fcb3501c2
1 /*
2 * QEMU Crypto cipher nettle algorithms
4 * Copyright (c) 2015 Red Hat, Inc.
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
21 #include "qemu/osdep.h"
22 #include "crypto/xts.h"
24 #include <nettle/nettle-types.h>
25 #include <nettle/aes.h>
26 #include <nettle/des.h>
27 #include <nettle/cbc.h>
28 #include <nettle/cast128.h>
29 #include <nettle/serpent.h>
30 #include <nettle/twofish.h>
32 typedef void (*QCryptoCipherNettleFuncWrapper)(const void *ctx,
33 size_t length,
34 uint8_t *dst,
35 const uint8_t *src);
37 #if CONFIG_NETTLE_VERSION_MAJOR < 3
38 typedef nettle_crypt_func * QCryptoCipherNettleFuncNative;
39 typedef void * cipher_ctx_t;
40 typedef unsigned cipher_length_t;
42 #define cast5_set_key cast128_set_key
43 #else
44 typedef nettle_cipher_func * QCryptoCipherNettleFuncNative;
45 typedef const void * cipher_ctx_t;
46 typedef size_t cipher_length_t;
47 #endif
49 typedef struct QCryptoNettleAES {
50 struct aes_ctx enc;
51 struct aes_ctx dec;
52 } QCryptoNettleAES;
54 static void aes_encrypt_native(cipher_ctx_t ctx, cipher_length_t length,
55 uint8_t *dst, const uint8_t *src)
57 const QCryptoNettleAES *aesctx = ctx;
58 aes_encrypt(&aesctx->enc, length, dst, src);
61 static void aes_decrypt_native(cipher_ctx_t ctx, cipher_length_t length,
62 uint8_t *dst, const uint8_t *src)
64 const QCryptoNettleAES *aesctx = ctx;
65 aes_decrypt(&aesctx->dec, length, dst, src);
68 static void des_encrypt_native(cipher_ctx_t ctx, cipher_length_t length,
69 uint8_t *dst, const uint8_t *src)
71 des_encrypt(ctx, length, dst, src);
74 static void des_decrypt_native(cipher_ctx_t ctx, cipher_length_t length,
75 uint8_t *dst, const uint8_t *src)
77 des_decrypt(ctx, length, dst, src);
80 static void cast128_encrypt_native(cipher_ctx_t ctx, cipher_length_t length,
81 uint8_t *dst, const uint8_t *src)
83 cast128_encrypt(ctx, length, dst, src);
86 static void cast128_decrypt_native(cipher_ctx_t ctx, cipher_length_t length,
87 uint8_t *dst, const uint8_t *src)
89 cast128_decrypt(ctx, length, dst, src);
92 static void serpent_encrypt_native(cipher_ctx_t ctx, cipher_length_t length,
93 uint8_t *dst, const uint8_t *src)
95 serpent_encrypt(ctx, length, dst, src);
98 static void serpent_decrypt_native(cipher_ctx_t ctx, cipher_length_t length,
99 uint8_t *dst, const uint8_t *src)
101 serpent_decrypt(ctx, length, dst, src);
104 static void twofish_encrypt_native(cipher_ctx_t ctx, cipher_length_t length,
105 uint8_t *dst, const uint8_t *src)
107 twofish_encrypt(ctx, length, dst, src);
110 static void twofish_decrypt_native(cipher_ctx_t ctx, cipher_length_t length,
111 uint8_t *dst, const uint8_t *src)
113 twofish_decrypt(ctx, length, dst, src);
116 static void aes_encrypt_wrapper(const void *ctx, size_t length,
117 uint8_t *dst, const uint8_t *src)
119 const QCryptoNettleAES *aesctx = ctx;
120 aes_encrypt(&aesctx->enc, length, dst, src);
123 static void aes_decrypt_wrapper(const void *ctx, size_t length,
124 uint8_t *dst, const uint8_t *src)
126 const QCryptoNettleAES *aesctx = ctx;
127 aes_decrypt(&aesctx->dec, length, dst, src);
130 static void des_encrypt_wrapper(const void *ctx, size_t length,
131 uint8_t *dst, const uint8_t *src)
133 des_encrypt(ctx, length, dst, src);
136 static void des_decrypt_wrapper(const void *ctx, size_t length,
137 uint8_t *dst, const uint8_t *src)
139 des_decrypt(ctx, length, dst, src);
142 static void cast128_encrypt_wrapper(const void *ctx, size_t length,
143 uint8_t *dst, const uint8_t *src)
145 cast128_encrypt(ctx, length, dst, src);
148 static void cast128_decrypt_wrapper(const void *ctx, size_t length,
149 uint8_t *dst, const uint8_t *src)
151 cast128_decrypt(ctx, length, dst, src);
154 static void serpent_encrypt_wrapper(const void *ctx, size_t length,
155 uint8_t *dst, const uint8_t *src)
157 serpent_encrypt(ctx, length, dst, src);
160 static void serpent_decrypt_wrapper(const void *ctx, size_t length,
161 uint8_t *dst, const uint8_t *src)
163 serpent_decrypt(ctx, length, dst, src);
166 static void twofish_encrypt_wrapper(const void *ctx, size_t length,
167 uint8_t *dst, const uint8_t *src)
169 twofish_encrypt(ctx, length, dst, src);
172 static void twofish_decrypt_wrapper(const void *ctx, size_t length,
173 uint8_t *dst, const uint8_t *src)
175 twofish_decrypt(ctx, length, dst, src);
178 typedef struct QCryptoCipherNettle QCryptoCipherNettle;
179 struct QCryptoCipherNettle {
180 /* Primary cipher context for all modes */
181 void *ctx;
182 /* Second cipher context for XTS mode only */
183 void *ctx_tweak;
184 /* Cipher callbacks for both contexts */
185 QCryptoCipherNettleFuncNative alg_encrypt_native;
186 QCryptoCipherNettleFuncNative alg_decrypt_native;
187 QCryptoCipherNettleFuncWrapper alg_encrypt_wrapper;
188 QCryptoCipherNettleFuncWrapper alg_decrypt_wrapper;
190 uint8_t *iv;
191 size_t blocksize;
194 bool qcrypto_cipher_supports(QCryptoCipherAlgorithm alg)
196 switch (alg) {
197 case QCRYPTO_CIPHER_ALG_DES_RFB:
198 case QCRYPTO_CIPHER_ALG_AES_128:
199 case QCRYPTO_CIPHER_ALG_AES_192:
200 case QCRYPTO_CIPHER_ALG_AES_256:
201 case QCRYPTO_CIPHER_ALG_CAST5_128:
202 case QCRYPTO_CIPHER_ALG_SERPENT_128:
203 case QCRYPTO_CIPHER_ALG_SERPENT_192:
204 case QCRYPTO_CIPHER_ALG_SERPENT_256:
205 case QCRYPTO_CIPHER_ALG_TWOFISH_128:
206 case QCRYPTO_CIPHER_ALG_TWOFISH_192:
207 case QCRYPTO_CIPHER_ALG_TWOFISH_256:
208 return true;
209 default:
210 return false;
215 QCryptoCipher *qcrypto_cipher_new(QCryptoCipherAlgorithm alg,
216 QCryptoCipherMode mode,
217 const uint8_t *key, size_t nkey,
218 Error **errp)
220 QCryptoCipher *cipher;
221 QCryptoCipherNettle *ctx;
222 uint8_t *rfbkey;
224 switch (mode) {
225 case QCRYPTO_CIPHER_MODE_ECB:
226 case QCRYPTO_CIPHER_MODE_CBC:
227 case QCRYPTO_CIPHER_MODE_XTS:
228 break;
229 default:
230 error_setg(errp, "Unsupported cipher mode %d", mode);
231 return NULL;
234 if (!qcrypto_cipher_validate_key_length(alg, mode, nkey, errp)) {
235 return NULL;
238 cipher = g_new0(QCryptoCipher, 1);
239 cipher->alg = alg;
240 cipher->mode = mode;
242 ctx = g_new0(QCryptoCipherNettle, 1);
244 switch (alg) {
245 case QCRYPTO_CIPHER_ALG_DES_RFB:
246 ctx->ctx = g_new0(struct des_ctx, 1);
247 rfbkey = qcrypto_cipher_munge_des_rfb_key(key, nkey);
248 des_set_key(ctx->ctx, rfbkey);
249 g_free(rfbkey);
251 ctx->alg_encrypt_native = des_encrypt_native;
252 ctx->alg_decrypt_native = des_decrypt_native;
253 ctx->alg_encrypt_wrapper = des_encrypt_wrapper;
254 ctx->alg_decrypt_wrapper = des_decrypt_wrapper;
256 ctx->blocksize = DES_BLOCK_SIZE;
257 break;
259 case QCRYPTO_CIPHER_ALG_AES_128:
260 case QCRYPTO_CIPHER_ALG_AES_192:
261 case QCRYPTO_CIPHER_ALG_AES_256:
262 ctx->ctx = g_new0(QCryptoNettleAES, 1);
264 if (mode == QCRYPTO_CIPHER_MODE_XTS) {
265 ctx->ctx_tweak = g_new0(QCryptoNettleAES, 1);
267 nkey /= 2;
268 aes_set_encrypt_key(&((QCryptoNettleAES *)ctx->ctx)->enc,
269 nkey, key);
270 aes_set_decrypt_key(&((QCryptoNettleAES *)ctx->ctx)->dec,
271 nkey, key);
273 aes_set_encrypt_key(&((QCryptoNettleAES *)ctx->ctx_tweak)->enc,
274 nkey, key + nkey);
275 aes_set_decrypt_key(&((QCryptoNettleAES *)ctx->ctx_tweak)->dec,
276 nkey, key + nkey);
277 } else {
278 aes_set_encrypt_key(&((QCryptoNettleAES *)ctx->ctx)->enc,
279 nkey, key);
280 aes_set_decrypt_key(&((QCryptoNettleAES *)ctx->ctx)->dec,
281 nkey, key);
284 ctx->alg_encrypt_native = aes_encrypt_native;
285 ctx->alg_decrypt_native = aes_decrypt_native;
286 ctx->alg_encrypt_wrapper = aes_encrypt_wrapper;
287 ctx->alg_decrypt_wrapper = aes_decrypt_wrapper;
289 ctx->blocksize = AES_BLOCK_SIZE;
290 break;
292 case QCRYPTO_CIPHER_ALG_CAST5_128:
293 ctx->ctx = g_new0(struct cast128_ctx, 1);
295 if (mode == QCRYPTO_CIPHER_MODE_XTS) {
296 ctx->ctx_tweak = g_new0(struct cast128_ctx, 1);
298 nkey /= 2;
299 cast5_set_key(ctx->ctx, nkey, key);
300 cast5_set_key(ctx->ctx_tweak, nkey, key + nkey);
301 } else {
302 cast5_set_key(ctx->ctx, nkey, key);
305 ctx->alg_encrypt_native = cast128_encrypt_native;
306 ctx->alg_decrypt_native = cast128_decrypt_native;
307 ctx->alg_encrypt_wrapper = cast128_encrypt_wrapper;
308 ctx->alg_decrypt_wrapper = cast128_decrypt_wrapper;
310 ctx->blocksize = CAST128_BLOCK_SIZE;
311 break;
313 case QCRYPTO_CIPHER_ALG_SERPENT_128:
314 case QCRYPTO_CIPHER_ALG_SERPENT_192:
315 case QCRYPTO_CIPHER_ALG_SERPENT_256:
316 ctx->ctx = g_new0(struct serpent_ctx, 1);
318 if (mode == QCRYPTO_CIPHER_MODE_XTS) {
319 ctx->ctx_tweak = g_new0(struct serpent_ctx, 1);
321 nkey /= 2;
322 serpent_set_key(ctx->ctx, nkey, key);
323 serpent_set_key(ctx->ctx_tweak, nkey, key + nkey);
324 } else {
325 serpent_set_key(ctx->ctx, nkey, key);
328 ctx->alg_encrypt_native = serpent_encrypt_native;
329 ctx->alg_decrypt_native = serpent_decrypt_native;
330 ctx->alg_encrypt_wrapper = serpent_encrypt_wrapper;
331 ctx->alg_decrypt_wrapper = serpent_decrypt_wrapper;
333 ctx->blocksize = SERPENT_BLOCK_SIZE;
334 break;
336 case QCRYPTO_CIPHER_ALG_TWOFISH_128:
337 case QCRYPTO_CIPHER_ALG_TWOFISH_192:
338 case QCRYPTO_CIPHER_ALG_TWOFISH_256:
339 ctx->ctx = g_new0(struct twofish_ctx, 1);
341 if (mode == QCRYPTO_CIPHER_MODE_XTS) {
342 ctx->ctx_tweak = g_new0(struct twofish_ctx, 1);
344 nkey /= 2;
345 twofish_set_key(ctx->ctx, nkey, key);
346 twofish_set_key(ctx->ctx_tweak, nkey, key + nkey);
347 } else {
348 twofish_set_key(ctx->ctx, nkey, key);
351 ctx->alg_encrypt_native = twofish_encrypt_native;
352 ctx->alg_decrypt_native = twofish_decrypt_native;
353 ctx->alg_encrypt_wrapper = twofish_encrypt_wrapper;
354 ctx->alg_decrypt_wrapper = twofish_decrypt_wrapper;
356 ctx->blocksize = TWOFISH_BLOCK_SIZE;
357 break;
359 default:
360 error_setg(errp, "Unsupported cipher algorithm %d", alg);
361 goto error;
364 ctx->iv = g_new0(uint8_t, ctx->blocksize);
365 cipher->opaque = ctx;
367 return cipher;
369 error:
370 g_free(cipher);
371 g_free(ctx);
372 return NULL;
376 void qcrypto_cipher_free(QCryptoCipher *cipher)
378 QCryptoCipherNettle *ctx;
380 if (!cipher) {
381 return;
384 ctx = cipher->opaque;
385 g_free(ctx->iv);
386 g_free(ctx->ctx);
387 g_free(ctx->ctx_tweak);
388 g_free(ctx);
389 g_free(cipher);
393 int qcrypto_cipher_encrypt(QCryptoCipher *cipher,
394 const void *in,
395 void *out,
396 size_t len,
397 Error **errp)
399 QCryptoCipherNettle *ctx = cipher->opaque;
401 if (len % ctx->blocksize) {
402 error_setg(errp, "Length %zu must be a multiple of block size %zu",
403 len, ctx->blocksize);
404 return -1;
407 switch (cipher->mode) {
408 case QCRYPTO_CIPHER_MODE_ECB:
409 ctx->alg_encrypt_wrapper(ctx->ctx, len, out, in);
410 break;
412 case QCRYPTO_CIPHER_MODE_CBC:
413 cbc_encrypt(ctx->ctx, ctx->alg_encrypt_native,
414 ctx->blocksize, ctx->iv,
415 len, out, in);
416 break;
418 case QCRYPTO_CIPHER_MODE_XTS:
419 xts_encrypt(ctx->ctx, ctx->ctx_tweak,
420 ctx->alg_encrypt_wrapper, ctx->alg_encrypt_wrapper,
421 ctx->iv, len, out, in);
422 break;
424 default:
425 error_setg(errp, "Unsupported cipher algorithm %d",
426 cipher->alg);
427 return -1;
429 return 0;
433 int qcrypto_cipher_decrypt(QCryptoCipher *cipher,
434 const void *in,
435 void *out,
436 size_t len,
437 Error **errp)
439 QCryptoCipherNettle *ctx = cipher->opaque;
441 if (len % ctx->blocksize) {
442 error_setg(errp, "Length %zu must be a multiple of block size %zu",
443 len, ctx->blocksize);
444 return -1;
447 switch (cipher->mode) {
448 case QCRYPTO_CIPHER_MODE_ECB:
449 ctx->alg_decrypt_wrapper(ctx->ctx, len, out, in);
450 break;
452 case QCRYPTO_CIPHER_MODE_CBC:
453 cbc_decrypt(ctx->ctx, ctx->alg_decrypt_native,
454 ctx->blocksize, ctx->iv,
455 len, out, in);
456 break;
458 case QCRYPTO_CIPHER_MODE_XTS:
459 if (ctx->blocksize != XTS_BLOCK_SIZE) {
460 error_setg(errp, "Block size must be %d not %zu",
461 XTS_BLOCK_SIZE, ctx->blocksize);
462 return -1;
464 xts_decrypt(ctx->ctx, ctx->ctx_tweak,
465 ctx->alg_encrypt_wrapper, ctx->alg_decrypt_wrapper,
466 ctx->iv, len, out, in);
467 break;
469 default:
470 error_setg(errp, "Unsupported cipher algorithm %d",
471 cipher->alg);
472 return -1;
474 return 0;
477 int qcrypto_cipher_setiv(QCryptoCipher *cipher,
478 const uint8_t *iv, size_t niv,
479 Error **errp)
481 QCryptoCipherNettle *ctx = cipher->opaque;
482 if (niv != ctx->blocksize) {
483 error_setg(errp, "Expected IV size %zu not %zu",
484 ctx->blocksize, niv);
485 return -1;
487 memcpy(ctx->iv, iv, niv);
488 return 0;