forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
802 lines
20 KiB
802 lines
20 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
/* |
|
* Cryptographic API. |
|
* |
|
* s390 implementation of the AES Cipher Algorithm with protected keys. |
|
* |
|
* s390 Version: |
|
* Copyright IBM Corp. 2017,2020 |
|
* Author(s): Martin Schwidefsky <[email protected]> |
|
* Harald Freudenberger <[email protected]> |
|
*/ |
|
|
|
#define KMSG_COMPONENT "paes_s390" |
|
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt |
|
|
|
#include <crypto/aes.h> |
|
#include <crypto/algapi.h> |
|
#include <linux/bug.h> |
|
#include <linux/err.h> |
|
#include <linux/module.h> |
|
#include <linux/cpufeature.h> |
|
#include <linux/init.h> |
|
#include <linux/mutex.h> |
|
#include <linux/spinlock.h> |
|
#include <linux/delay.h> |
|
#include <crypto/internal/skcipher.h> |
|
#include <crypto/xts.h> |
|
#include <asm/cpacf.h> |
|
#include <asm/pkey.h> |
|
|
|
/* |
|
* Key blobs smaller/bigger than these defines are rejected |
|
* by the common code even before the individual setkey function |
|
* is called. As paes can handle different kinds of key blobs |
|
* and padding is also possible, the limits need to be generous. |
|
*/ |
|
#define PAES_MIN_KEYSIZE 16 |
|
#define PAES_MAX_KEYSIZE 320 |
|
|
|
static u8 *ctrblk; |
|
static DEFINE_MUTEX(ctrblk_lock); |
|
|
|
static cpacf_mask_t km_functions, kmc_functions, kmctr_functions; |
|
|
|
struct key_blob { |
|
/* |
|
* Small keys will be stored in the keybuf. Larger keys are |
|
* stored in extra allocated memory. In both cases does |
|
* key point to the memory where the key is stored. |
|
* The code distinguishes by checking keylen against |
|
* sizeof(keybuf). See the two following helper functions. |
|
*/ |
|
u8 *key; |
|
u8 keybuf[128]; |
|
unsigned int keylen; |
|
}; |
|
|
|
static inline int _key_to_kb(struct key_blob *kb, |
|
const u8 *key, |
|
unsigned int keylen) |
|
{ |
|
struct clearkey_header { |
|
u8 type; |
|
u8 res0[3]; |
|
u8 version; |
|
u8 res1[3]; |
|
u32 keytype; |
|
u32 len; |
|
} __packed * h; |
|
|
|
switch (keylen) { |
|
case 16: |
|
case 24: |
|
case 32: |
|
/* clear key value, prepare pkey clear key token in keybuf */ |
|
memset(kb->keybuf, 0, sizeof(kb->keybuf)); |
|
h = (struct clearkey_header *) kb->keybuf; |
|
h->version = 0x02; /* TOKVER_CLEAR_KEY */ |
|
h->keytype = (keylen - 8) >> 3; |
|
h->len = keylen; |
|
memcpy(kb->keybuf + sizeof(*h), key, keylen); |
|
kb->keylen = sizeof(*h) + keylen; |
|
kb->key = kb->keybuf; |
|
break; |
|
default: |
|
/* other key material, let pkey handle this */ |
|
if (keylen <= sizeof(kb->keybuf)) |
|
kb->key = kb->keybuf; |
|
else { |
|
kb->key = kmalloc(keylen, GFP_KERNEL); |
|
if (!kb->key) |
|
return -ENOMEM; |
|
} |
|
memcpy(kb->key, key, keylen); |
|
kb->keylen = keylen; |
|
break; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static inline void _free_kb_keybuf(struct key_blob *kb) |
|
{ |
|
if (kb->key && kb->key != kb->keybuf |
|
&& kb->keylen > sizeof(kb->keybuf)) { |
|
kfree(kb->key); |
|
kb->key = NULL; |
|
} |
|
} |
|
|
|
struct s390_paes_ctx { |
|
struct key_blob kb; |
|
struct pkey_protkey pk; |
|
spinlock_t pk_lock; |
|
unsigned long fc; |
|
}; |
|
|
|
struct s390_pxts_ctx { |
|
struct key_blob kb[2]; |
|
struct pkey_protkey pk[2]; |
|
spinlock_t pk_lock; |
|
unsigned long fc; |
|
}; |
|
|
|
static inline int __paes_keyblob2pkey(struct key_blob *kb, |
|
struct pkey_protkey *pk) |
|
{ |
|
int i, ret; |
|
|
|
/* try three times in case of failure */ |
|
for (i = 0; i < 3; i++) { |
|
if (i > 0 && ret == -EAGAIN && in_task()) |
|
if (msleep_interruptible(1000)) |
|
return -EINTR; |
|
ret = pkey_keyblob2pkey(kb->key, kb->keylen, pk); |
|
if (ret == 0) |
|
break; |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static inline int __paes_convert_key(struct s390_paes_ctx *ctx) |
|
{ |
|
int ret; |
|
struct pkey_protkey pkey; |
|
|
|
ret = __paes_keyblob2pkey(&ctx->kb, &pkey); |
|
if (ret) |
|
return ret; |
|
|
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(&ctx->pk, &pkey, sizeof(pkey)); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
|
|
return 0; |
|
} |
|
|
|
static int ecb_paes_init(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
ctx->kb.key = NULL; |
|
spin_lock_init(&ctx->pk_lock); |
|
|
|
return 0; |
|
} |
|
|
|
static void ecb_paes_exit(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb); |
|
} |
|
|
|
static inline int __ecb_paes_set_key(struct s390_paes_ctx *ctx) |
|
{ |
|
int rc; |
|
unsigned long fc; |
|
|
|
rc = __paes_convert_key(ctx); |
|
if (rc) |
|
return rc; |
|
|
|
/* Pick the correct function code based on the protected key type */ |
|
fc = (ctx->pk.type == PKEY_KEYTYPE_AES_128) ? CPACF_KM_PAES_128 : |
|
(ctx->pk.type == PKEY_KEYTYPE_AES_192) ? CPACF_KM_PAES_192 : |
|
(ctx->pk.type == PKEY_KEYTYPE_AES_256) ? CPACF_KM_PAES_256 : 0; |
|
|
|
/* Check if the function code is available */ |
|
ctx->fc = (fc && cpacf_test_func(&km_functions, fc)) ? fc : 0; |
|
|
|
return ctx->fc ? 0 : -EINVAL; |
|
} |
|
|
|
static int ecb_paes_set_key(struct crypto_skcipher *tfm, const u8 *in_key, |
|
unsigned int key_len) |
|
{ |
|
int rc; |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb); |
|
rc = _key_to_kb(&ctx->kb, in_key, key_len); |
|
if (rc) |
|
return rc; |
|
|
|
return __ecb_paes_set_key(ctx); |
|
} |
|
|
|
static int ecb_paes_crypt(struct skcipher_request *req, unsigned long modifier) |
|
{ |
|
struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req); |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
struct skcipher_walk walk; |
|
unsigned int nbytes, n, k; |
|
int ret; |
|
struct { |
|
u8 key[MAXPROTKEYSIZE]; |
|
} param; |
|
|
|
ret = skcipher_walk_virt(&walk, req, false); |
|
if (ret) |
|
return ret; |
|
|
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
|
|
while ((nbytes = walk.nbytes) != 0) { |
|
/* only use complete blocks */ |
|
n = nbytes & ~(AES_BLOCK_SIZE - 1); |
|
k = cpacf_km(ctx->fc | modifier, ¶m, |
|
walk.dst.virt.addr, walk.src.virt.addr, n); |
|
if (k) |
|
ret = skcipher_walk_done(&walk, nbytes - k); |
|
if (k < n) { |
|
if (__paes_convert_key(ctx)) |
|
return skcipher_walk_done(&walk, -EIO); |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
} |
|
} |
|
return ret; |
|
} |
|
|
|
static int ecb_paes_encrypt(struct skcipher_request *req) |
|
{ |
|
return ecb_paes_crypt(req, 0); |
|
} |
|
|
|
static int ecb_paes_decrypt(struct skcipher_request *req) |
|
{ |
|
return ecb_paes_crypt(req, CPACF_DECRYPT); |
|
} |
|
|
|
static struct skcipher_alg ecb_paes_alg = { |
|
.base.cra_name = "ecb(paes)", |
|
.base.cra_driver_name = "ecb-paes-s390", |
|
.base.cra_priority = 401, /* combo: aes + ecb + 1 */ |
|
.base.cra_blocksize = AES_BLOCK_SIZE, |
|
.base.cra_ctxsize = sizeof(struct s390_paes_ctx), |
|
.base.cra_module = THIS_MODULE, |
|
.base.cra_list = LIST_HEAD_INIT(ecb_paes_alg.base.cra_list), |
|
.init = ecb_paes_init, |
|
.exit = ecb_paes_exit, |
|
.min_keysize = PAES_MIN_KEYSIZE, |
|
.max_keysize = PAES_MAX_KEYSIZE, |
|
.setkey = ecb_paes_set_key, |
|
.encrypt = ecb_paes_encrypt, |
|
.decrypt = ecb_paes_decrypt, |
|
}; |
|
|
|
static int cbc_paes_init(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
ctx->kb.key = NULL; |
|
spin_lock_init(&ctx->pk_lock); |
|
|
|
return 0; |
|
} |
|
|
|
static void cbc_paes_exit(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb); |
|
} |
|
|
|
static inline int __cbc_paes_set_key(struct s390_paes_ctx *ctx) |
|
{ |
|
int rc; |
|
unsigned long fc; |
|
|
|
rc = __paes_convert_key(ctx); |
|
if (rc) |
|
return rc; |
|
|
|
/* Pick the correct function code based on the protected key type */ |
|
fc = (ctx->pk.type == PKEY_KEYTYPE_AES_128) ? CPACF_KMC_PAES_128 : |
|
(ctx->pk.type == PKEY_KEYTYPE_AES_192) ? CPACF_KMC_PAES_192 : |
|
(ctx->pk.type == PKEY_KEYTYPE_AES_256) ? CPACF_KMC_PAES_256 : 0; |
|
|
|
/* Check if the function code is available */ |
|
ctx->fc = (fc && cpacf_test_func(&kmc_functions, fc)) ? fc : 0; |
|
|
|
return ctx->fc ? 0 : -EINVAL; |
|
} |
|
|
|
static int cbc_paes_set_key(struct crypto_skcipher *tfm, const u8 *in_key, |
|
unsigned int key_len) |
|
{ |
|
int rc; |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb); |
|
rc = _key_to_kb(&ctx->kb, in_key, key_len); |
|
if (rc) |
|
return rc; |
|
|
|
return __cbc_paes_set_key(ctx); |
|
} |
|
|
|
static int cbc_paes_crypt(struct skcipher_request *req, unsigned long modifier) |
|
{ |
|
struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req); |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
struct skcipher_walk walk; |
|
unsigned int nbytes, n, k; |
|
int ret; |
|
struct { |
|
u8 iv[AES_BLOCK_SIZE]; |
|
u8 key[MAXPROTKEYSIZE]; |
|
} param; |
|
|
|
ret = skcipher_walk_virt(&walk, req, false); |
|
if (ret) |
|
return ret; |
|
|
|
memcpy(param.iv, walk.iv, AES_BLOCK_SIZE); |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
|
|
while ((nbytes = walk.nbytes) != 0) { |
|
/* only use complete blocks */ |
|
n = nbytes & ~(AES_BLOCK_SIZE - 1); |
|
k = cpacf_kmc(ctx->fc | modifier, ¶m, |
|
walk.dst.virt.addr, walk.src.virt.addr, n); |
|
if (k) { |
|
memcpy(walk.iv, param.iv, AES_BLOCK_SIZE); |
|
ret = skcipher_walk_done(&walk, nbytes - k); |
|
} |
|
if (k < n) { |
|
if (__paes_convert_key(ctx)) |
|
return skcipher_walk_done(&walk, -EIO); |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
} |
|
} |
|
return ret; |
|
} |
|
|
|
static int cbc_paes_encrypt(struct skcipher_request *req) |
|
{ |
|
return cbc_paes_crypt(req, 0); |
|
} |
|
|
|
static int cbc_paes_decrypt(struct skcipher_request *req) |
|
{ |
|
return cbc_paes_crypt(req, CPACF_DECRYPT); |
|
} |
|
|
|
static struct skcipher_alg cbc_paes_alg = { |
|
.base.cra_name = "cbc(paes)", |
|
.base.cra_driver_name = "cbc-paes-s390", |
|
.base.cra_priority = 402, /* ecb-paes-s390 + 1 */ |
|
.base.cra_blocksize = AES_BLOCK_SIZE, |
|
.base.cra_ctxsize = sizeof(struct s390_paes_ctx), |
|
.base.cra_module = THIS_MODULE, |
|
.base.cra_list = LIST_HEAD_INIT(cbc_paes_alg.base.cra_list), |
|
.init = cbc_paes_init, |
|
.exit = cbc_paes_exit, |
|
.min_keysize = PAES_MIN_KEYSIZE, |
|
.max_keysize = PAES_MAX_KEYSIZE, |
|
.ivsize = AES_BLOCK_SIZE, |
|
.setkey = cbc_paes_set_key, |
|
.encrypt = cbc_paes_encrypt, |
|
.decrypt = cbc_paes_decrypt, |
|
}; |
|
|
|
static int xts_paes_init(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_pxts_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
ctx->kb[0].key = NULL; |
|
ctx->kb[1].key = NULL; |
|
spin_lock_init(&ctx->pk_lock); |
|
|
|
return 0; |
|
} |
|
|
|
static void xts_paes_exit(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_pxts_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb[0]); |
|
_free_kb_keybuf(&ctx->kb[1]); |
|
} |
|
|
|
static inline int __xts_paes_convert_key(struct s390_pxts_ctx *ctx) |
|
{ |
|
struct pkey_protkey pkey0, pkey1; |
|
|
|
if (__paes_keyblob2pkey(&ctx->kb[0], &pkey0) || |
|
__paes_keyblob2pkey(&ctx->kb[1], &pkey1)) |
|
return -EINVAL; |
|
|
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(&ctx->pk[0], &pkey0, sizeof(pkey0)); |
|
memcpy(&ctx->pk[1], &pkey1, sizeof(pkey1)); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
|
|
return 0; |
|
} |
|
|
|
static inline int __xts_paes_set_key(struct s390_pxts_ctx *ctx) |
|
{ |
|
unsigned long fc; |
|
|
|
if (__xts_paes_convert_key(ctx)) |
|
return -EINVAL; |
|
|
|
if (ctx->pk[0].type != ctx->pk[1].type) |
|
return -EINVAL; |
|
|
|
/* Pick the correct function code based on the protected key type */ |
|
fc = (ctx->pk[0].type == PKEY_KEYTYPE_AES_128) ? CPACF_KM_PXTS_128 : |
|
(ctx->pk[0].type == PKEY_KEYTYPE_AES_256) ? |
|
CPACF_KM_PXTS_256 : 0; |
|
|
|
/* Check if the function code is available */ |
|
ctx->fc = (fc && cpacf_test_func(&km_functions, fc)) ? fc : 0; |
|
|
|
return ctx->fc ? 0 : -EINVAL; |
|
} |
|
|
|
static int xts_paes_set_key(struct crypto_skcipher *tfm, const u8 *in_key, |
|
unsigned int xts_key_len) |
|
{ |
|
int rc; |
|
struct s390_pxts_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
u8 ckey[2 * AES_MAX_KEY_SIZE]; |
|
unsigned int ckey_len, key_len; |
|
|
|
if (xts_key_len % 2) |
|
return -EINVAL; |
|
|
|
key_len = xts_key_len / 2; |
|
|
|
_free_kb_keybuf(&ctx->kb[0]); |
|
_free_kb_keybuf(&ctx->kb[1]); |
|
rc = _key_to_kb(&ctx->kb[0], in_key, key_len); |
|
if (rc) |
|
return rc; |
|
rc = _key_to_kb(&ctx->kb[1], in_key + key_len, key_len); |
|
if (rc) |
|
return rc; |
|
|
|
rc = __xts_paes_set_key(ctx); |
|
if (rc) |
|
return rc; |
|
|
|
/* |
|
* xts_check_key verifies the key length is not odd and makes |
|
* sure that the two keys are not the same. This can be done |
|
* on the two protected keys as well |
|
*/ |
|
ckey_len = (ctx->pk[0].type == PKEY_KEYTYPE_AES_128) ? |
|
AES_KEYSIZE_128 : AES_KEYSIZE_256; |
|
memcpy(ckey, ctx->pk[0].protkey, ckey_len); |
|
memcpy(ckey + ckey_len, ctx->pk[1].protkey, ckey_len); |
|
return xts_verify_key(tfm, ckey, 2*ckey_len); |
|
} |
|
|
|
static int xts_paes_crypt(struct skcipher_request *req, unsigned long modifier) |
|
{ |
|
struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req); |
|
struct s390_pxts_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
struct skcipher_walk walk; |
|
unsigned int keylen, offset, nbytes, n, k; |
|
int ret; |
|
struct { |
|
u8 key[MAXPROTKEYSIZE]; /* key + verification pattern */ |
|
u8 tweak[16]; |
|
u8 block[16]; |
|
u8 bit[16]; |
|
u8 xts[16]; |
|
} pcc_param; |
|
struct { |
|
u8 key[MAXPROTKEYSIZE]; /* key + verification pattern */ |
|
u8 init[16]; |
|
} xts_param; |
|
|
|
ret = skcipher_walk_virt(&walk, req, false); |
|
if (ret) |
|
return ret; |
|
|
|
keylen = (ctx->pk[0].type == PKEY_KEYTYPE_AES_128) ? 48 : 64; |
|
offset = (ctx->pk[0].type == PKEY_KEYTYPE_AES_128) ? 16 : 0; |
|
|
|
memset(&pcc_param, 0, sizeof(pcc_param)); |
|
memcpy(pcc_param.tweak, walk.iv, sizeof(pcc_param.tweak)); |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(pcc_param.key + offset, ctx->pk[1].protkey, keylen); |
|
memcpy(xts_param.key + offset, ctx->pk[0].protkey, keylen); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
cpacf_pcc(ctx->fc, pcc_param.key + offset); |
|
memcpy(xts_param.init, pcc_param.xts, 16); |
|
|
|
while ((nbytes = walk.nbytes) != 0) { |
|
/* only use complete blocks */ |
|
n = nbytes & ~(AES_BLOCK_SIZE - 1); |
|
k = cpacf_km(ctx->fc | modifier, xts_param.key + offset, |
|
walk.dst.virt.addr, walk.src.virt.addr, n); |
|
if (k) |
|
ret = skcipher_walk_done(&walk, nbytes - k); |
|
if (k < n) { |
|
if (__xts_paes_convert_key(ctx)) |
|
return skcipher_walk_done(&walk, -EIO); |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(xts_param.key + offset, |
|
ctx->pk[0].protkey, keylen); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
} |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static int xts_paes_encrypt(struct skcipher_request *req) |
|
{ |
|
return xts_paes_crypt(req, 0); |
|
} |
|
|
|
static int xts_paes_decrypt(struct skcipher_request *req) |
|
{ |
|
return xts_paes_crypt(req, CPACF_DECRYPT); |
|
} |
|
|
|
static struct skcipher_alg xts_paes_alg = { |
|
.base.cra_name = "xts(paes)", |
|
.base.cra_driver_name = "xts-paes-s390", |
|
.base.cra_priority = 402, /* ecb-paes-s390 + 1 */ |
|
.base.cra_blocksize = AES_BLOCK_SIZE, |
|
.base.cra_ctxsize = sizeof(struct s390_pxts_ctx), |
|
.base.cra_module = THIS_MODULE, |
|
.base.cra_list = LIST_HEAD_INIT(xts_paes_alg.base.cra_list), |
|
.init = xts_paes_init, |
|
.exit = xts_paes_exit, |
|
.min_keysize = 2 * PAES_MIN_KEYSIZE, |
|
.max_keysize = 2 * PAES_MAX_KEYSIZE, |
|
.ivsize = AES_BLOCK_SIZE, |
|
.setkey = xts_paes_set_key, |
|
.encrypt = xts_paes_encrypt, |
|
.decrypt = xts_paes_decrypt, |
|
}; |
|
|
|
static int ctr_paes_init(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
ctx->kb.key = NULL; |
|
spin_lock_init(&ctx->pk_lock); |
|
|
|
return 0; |
|
} |
|
|
|
static void ctr_paes_exit(struct crypto_skcipher *tfm) |
|
{ |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb); |
|
} |
|
|
|
static inline int __ctr_paes_set_key(struct s390_paes_ctx *ctx) |
|
{ |
|
int rc; |
|
unsigned long fc; |
|
|
|
rc = __paes_convert_key(ctx); |
|
if (rc) |
|
return rc; |
|
|
|
/* Pick the correct function code based on the protected key type */ |
|
fc = (ctx->pk.type == PKEY_KEYTYPE_AES_128) ? CPACF_KMCTR_PAES_128 : |
|
(ctx->pk.type == PKEY_KEYTYPE_AES_192) ? CPACF_KMCTR_PAES_192 : |
|
(ctx->pk.type == PKEY_KEYTYPE_AES_256) ? |
|
CPACF_KMCTR_PAES_256 : 0; |
|
|
|
/* Check if the function code is available */ |
|
ctx->fc = (fc && cpacf_test_func(&kmctr_functions, fc)) ? fc : 0; |
|
|
|
return ctx->fc ? 0 : -EINVAL; |
|
} |
|
|
|
static int ctr_paes_set_key(struct crypto_skcipher *tfm, const u8 *in_key, |
|
unsigned int key_len) |
|
{ |
|
int rc; |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
|
|
_free_kb_keybuf(&ctx->kb); |
|
rc = _key_to_kb(&ctx->kb, in_key, key_len); |
|
if (rc) |
|
return rc; |
|
|
|
return __ctr_paes_set_key(ctx); |
|
} |
|
|
|
static unsigned int __ctrblk_init(u8 *ctrptr, u8 *iv, unsigned int nbytes) |
|
{ |
|
unsigned int i, n; |
|
|
|
/* only use complete blocks, max. PAGE_SIZE */ |
|
memcpy(ctrptr, iv, AES_BLOCK_SIZE); |
|
n = (nbytes > PAGE_SIZE) ? PAGE_SIZE : nbytes & ~(AES_BLOCK_SIZE - 1); |
|
for (i = (n / AES_BLOCK_SIZE) - 1; i > 0; i--) { |
|
memcpy(ctrptr + AES_BLOCK_SIZE, ctrptr, AES_BLOCK_SIZE); |
|
crypto_inc(ctrptr + AES_BLOCK_SIZE, AES_BLOCK_SIZE); |
|
ctrptr += AES_BLOCK_SIZE; |
|
} |
|
return n; |
|
} |
|
|
|
static int ctr_paes_crypt(struct skcipher_request *req) |
|
{ |
|
struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req); |
|
struct s390_paes_ctx *ctx = crypto_skcipher_ctx(tfm); |
|
u8 buf[AES_BLOCK_SIZE], *ctrptr; |
|
struct skcipher_walk walk; |
|
unsigned int nbytes, n, k; |
|
int ret, locked; |
|
struct { |
|
u8 key[MAXPROTKEYSIZE]; |
|
} param; |
|
|
|
ret = skcipher_walk_virt(&walk, req, false); |
|
if (ret) |
|
return ret; |
|
|
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
|
|
locked = mutex_trylock(&ctrblk_lock); |
|
|
|
while ((nbytes = walk.nbytes) >= AES_BLOCK_SIZE) { |
|
n = AES_BLOCK_SIZE; |
|
if (nbytes >= 2*AES_BLOCK_SIZE && locked) |
|
n = __ctrblk_init(ctrblk, walk.iv, nbytes); |
|
ctrptr = (n > AES_BLOCK_SIZE) ? ctrblk : walk.iv; |
|
k = cpacf_kmctr(ctx->fc, ¶m, walk.dst.virt.addr, |
|
walk.src.virt.addr, n, ctrptr); |
|
if (k) { |
|
if (ctrptr == ctrblk) |
|
memcpy(walk.iv, ctrptr + k - AES_BLOCK_SIZE, |
|
AES_BLOCK_SIZE); |
|
crypto_inc(walk.iv, AES_BLOCK_SIZE); |
|
ret = skcipher_walk_done(&walk, nbytes - k); |
|
} |
|
if (k < n) { |
|
if (__paes_convert_key(ctx)) { |
|
if (locked) |
|
mutex_unlock(&ctrblk_lock); |
|
return skcipher_walk_done(&walk, -EIO); |
|
} |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
} |
|
} |
|
if (locked) |
|
mutex_unlock(&ctrblk_lock); |
|
/* |
|
* final block may be < AES_BLOCK_SIZE, copy only nbytes |
|
*/ |
|
if (nbytes) { |
|
while (1) { |
|
if (cpacf_kmctr(ctx->fc, ¶m, buf, |
|
walk.src.virt.addr, AES_BLOCK_SIZE, |
|
walk.iv) == AES_BLOCK_SIZE) |
|
break; |
|
if (__paes_convert_key(ctx)) |
|
return skcipher_walk_done(&walk, -EIO); |
|
spin_lock_bh(&ctx->pk_lock); |
|
memcpy(param.key, ctx->pk.protkey, MAXPROTKEYSIZE); |
|
spin_unlock_bh(&ctx->pk_lock); |
|
} |
|
memcpy(walk.dst.virt.addr, buf, nbytes); |
|
crypto_inc(walk.iv, AES_BLOCK_SIZE); |
|
ret = skcipher_walk_done(&walk, nbytes); |
|
} |
|
|
|
return ret; |
|
} |
|
|
|
static struct skcipher_alg ctr_paes_alg = { |
|
.base.cra_name = "ctr(paes)", |
|
.base.cra_driver_name = "ctr-paes-s390", |
|
.base.cra_priority = 402, /* ecb-paes-s390 + 1 */ |
|
.base.cra_blocksize = 1, |
|
.base.cra_ctxsize = sizeof(struct s390_paes_ctx), |
|
.base.cra_module = THIS_MODULE, |
|
.base.cra_list = LIST_HEAD_INIT(ctr_paes_alg.base.cra_list), |
|
.init = ctr_paes_init, |
|
.exit = ctr_paes_exit, |
|
.min_keysize = PAES_MIN_KEYSIZE, |
|
.max_keysize = PAES_MAX_KEYSIZE, |
|
.ivsize = AES_BLOCK_SIZE, |
|
.setkey = ctr_paes_set_key, |
|
.encrypt = ctr_paes_crypt, |
|
.decrypt = ctr_paes_crypt, |
|
.chunksize = AES_BLOCK_SIZE, |
|
}; |
|
|
|
static inline void __crypto_unregister_skcipher(struct skcipher_alg *alg) |
|
{ |
|
if (!list_empty(&alg->base.cra_list)) |
|
crypto_unregister_skcipher(alg); |
|
} |
|
|
|
static void paes_s390_fini(void) |
|
{ |
|
__crypto_unregister_skcipher(&ctr_paes_alg); |
|
__crypto_unregister_skcipher(&xts_paes_alg); |
|
__crypto_unregister_skcipher(&cbc_paes_alg); |
|
__crypto_unregister_skcipher(&ecb_paes_alg); |
|
if (ctrblk) |
|
free_page((unsigned long) ctrblk); |
|
} |
|
|
|
static int __init paes_s390_init(void) |
|
{ |
|
int ret; |
|
|
|
/* Query available functions for KM, KMC and KMCTR */ |
|
cpacf_query(CPACF_KM, &km_functions); |
|
cpacf_query(CPACF_KMC, &kmc_functions); |
|
cpacf_query(CPACF_KMCTR, &kmctr_functions); |
|
|
|
if (cpacf_test_func(&km_functions, CPACF_KM_PAES_128) || |
|
cpacf_test_func(&km_functions, CPACF_KM_PAES_192) || |
|
cpacf_test_func(&km_functions, CPACF_KM_PAES_256)) { |
|
ret = crypto_register_skcipher(&ecb_paes_alg); |
|
if (ret) |
|
goto out_err; |
|
} |
|
|
|
if (cpacf_test_func(&kmc_functions, CPACF_KMC_PAES_128) || |
|
cpacf_test_func(&kmc_functions, CPACF_KMC_PAES_192) || |
|
cpacf_test_func(&kmc_functions, CPACF_KMC_PAES_256)) { |
|
ret = crypto_register_skcipher(&cbc_paes_alg); |
|
if (ret) |
|
goto out_err; |
|
} |
|
|
|
if (cpacf_test_func(&km_functions, CPACF_KM_PXTS_128) || |
|
cpacf_test_func(&km_functions, CPACF_KM_PXTS_256)) { |
|
ret = crypto_register_skcipher(&xts_paes_alg); |
|
if (ret) |
|
goto out_err; |
|
} |
|
|
|
if (cpacf_test_func(&kmctr_functions, CPACF_KMCTR_PAES_128) || |
|
cpacf_test_func(&kmctr_functions, CPACF_KMCTR_PAES_192) || |
|
cpacf_test_func(&kmctr_functions, CPACF_KMCTR_PAES_256)) { |
|
ctrblk = (u8 *) __get_free_page(GFP_KERNEL); |
|
if (!ctrblk) { |
|
ret = -ENOMEM; |
|
goto out_err; |
|
} |
|
ret = crypto_register_skcipher(&ctr_paes_alg); |
|
if (ret) |
|
goto out_err; |
|
} |
|
|
|
return 0; |
|
out_err: |
|
paes_s390_fini(); |
|
return ret; |
|
} |
|
|
|
module_init(paes_s390_init); |
|
module_exit(paes_s390_fini); |
|
|
|
MODULE_ALIAS_CRYPTO("paes"); |
|
|
|
MODULE_DESCRIPTION("Rijndael (AES) Cipher Algorithm with protected keys"); |
|
MODULE_LICENSE("GPL");
|
|
|