862 lines
24 KiB
C
862 lines
24 KiB
C
|
/*
|
||
|
* Copyright 2016-2021 The OpenSSL Project Authors. All Rights Reserved.
|
||
|
*
|
||
|
* Licensed under the OpenSSL license (the "License"). You may not use
|
||
|
* this file except in compliance with the License. You can obtain a copy
|
||
|
* in the file LICENSE in the source distribution or at
|
||
|
* https://www.openssl.org/source/license.html
|
||
|
*/
|
||
|
|
||
|
/* Required for vmsplice */
|
||
|
#ifndef _GNU_SOURCE
|
||
|
# define _GNU_SOURCE
|
||
|
#endif
|
||
|
#include <stdio.h>
|
||
|
#include <string.h>
|
||
|
#include <unistd.h>
|
||
|
|
||
|
#include <openssl/engine.h>
|
||
|
#include <openssl/async.h>
|
||
|
#include <openssl/err.h>
|
||
|
#include "internal/nelem.h"
|
||
|
|
||
|
#include <sys/socket.h>
|
||
|
#include <linux/version.h>
|
||
|
#define K_MAJ 4
|
||
|
#define K_MIN1 1
|
||
|
#define K_MIN2 0
|
||
|
#if LINUX_VERSION_CODE < KERNEL_VERSION(K_MAJ, K_MIN1, K_MIN2) || \
|
||
|
!defined(AF_ALG)
|
||
|
# ifndef PEDANTIC
|
||
|
# warning "AFALG ENGINE requires Kernel Headers >= 4.1.0"
|
||
|
# warning "Skipping Compilation of AFALG engine"
|
||
|
# endif
|
||
|
void engine_load_afalg_int(void);
|
||
|
void engine_load_afalg_int(void)
|
||
|
{
|
||
|
}
|
||
|
#else
|
||
|
|
||
|
# include <linux/if_alg.h>
|
||
|
# include <fcntl.h>
|
||
|
# include <sys/utsname.h>
|
||
|
|
||
|
# include <linux/aio_abi.h>
|
||
|
# include <sys/syscall.h>
|
||
|
# include <errno.h>
|
||
|
|
||
|
# include "e_afalg.h"
|
||
|
# include "e_afalg_err.c"
|
||
|
|
||
|
# ifndef SOL_ALG
|
||
|
# define SOL_ALG 279
|
||
|
# endif
|
||
|
|
||
|
# ifdef ALG_ZERO_COPY
|
||
|
# ifndef SPLICE_F_GIFT
|
||
|
# define SPLICE_F_GIFT (0x08)
|
||
|
# endif
|
||
|
# endif
|
||
|
|
||
|
# define ALG_AES_IV_LEN 16
|
||
|
# define ALG_IV_LEN(len) (sizeof(struct af_alg_iv) + (len))
|
||
|
# define ALG_OP_TYPE unsigned int
|
||
|
# define ALG_OP_LEN (sizeof(ALG_OP_TYPE))
|
||
|
|
||
|
# ifdef OPENSSL_NO_DYNAMIC_ENGINE
|
||
|
void engine_load_afalg_int(void);
|
||
|
# endif
|
||
|
|
||
|
/* Local Linkage Functions */
|
||
|
static int afalg_init_aio(afalg_aio *aio);
|
||
|
static int afalg_fin_cipher_aio(afalg_aio *ptr, int sfd,
|
||
|
unsigned char *buf, size_t len);
|
||
|
static int afalg_create_sk(afalg_ctx *actx, const char *ciphertype,
|
||
|
const char *ciphername);
|
||
|
static int afalg_destroy(ENGINE *e);
|
||
|
static int afalg_init(ENGINE *e);
|
||
|
static int afalg_finish(ENGINE *e);
|
||
|
static const EVP_CIPHER *afalg_aes_cbc(int nid);
|
||
|
static cbc_handles *get_cipher_handle(int nid);
|
||
|
static int afalg_ciphers(ENGINE *e, const EVP_CIPHER **cipher,
|
||
|
const int **nids, int nid);
|
||
|
static int afalg_cipher_init(EVP_CIPHER_CTX *ctx, const unsigned char *key,
|
||
|
const unsigned char *iv, int enc);
|
||
|
static int afalg_do_cipher(EVP_CIPHER_CTX *ctx, unsigned char *out,
|
||
|
const unsigned char *in, size_t inl);
|
||
|
static int afalg_cipher_cleanup(EVP_CIPHER_CTX *ctx);
|
||
|
static int afalg_chk_platform(void);
|
||
|
|
||
|
/* Engine Id and Name */
|
||
|
static const char *engine_afalg_id = "afalg";
|
||
|
static const char *engine_afalg_name = "AFALG engine support";
|
||
|
|
||
|
static int afalg_cipher_nids[] = {
|
||
|
NID_aes_128_cbc,
|
||
|
NID_aes_192_cbc,
|
||
|
NID_aes_256_cbc,
|
||
|
};
|
||
|
|
||
|
static cbc_handles cbc_handle[] = {{AES_KEY_SIZE_128, NULL},
|
||
|
{AES_KEY_SIZE_192, NULL},
|
||
|
{AES_KEY_SIZE_256, NULL}};
|
||
|
|
||
|
static ossl_inline int io_setup(unsigned n, aio_context_t *ctx)
|
||
|
{
|
||
|
return syscall(__NR_io_setup, n, ctx);
|
||
|
}
|
||
|
|
||
|
static ossl_inline int eventfd(int n)
|
||
|
{
|
||
|
return syscall(__NR_eventfd2, n, 0);
|
||
|
}
|
||
|
|
||
|
static ossl_inline int io_destroy(aio_context_t ctx)
|
||
|
{
|
||
|
return syscall(__NR_io_destroy, ctx);
|
||
|
}
|
||
|
|
||
|
static ossl_inline int io_read(aio_context_t ctx, long n, struct iocb **iocb)
|
||
|
{
|
||
|
return syscall(__NR_io_submit, ctx, n, iocb);
|
||
|
}
|
||
|
|
||
|
static ossl_inline int io_getevents(aio_context_t ctx, long min, long max,
|
||
|
struct io_event *events,
|
||
|
struct timespec *timeout)
|
||
|
{
|
||
|
return syscall(__NR_io_getevents, ctx, min, max, events, timeout);
|
||
|
}
|
||
|
|
||
|
static void afalg_waitfd_cleanup(ASYNC_WAIT_CTX *ctx, const void *key,
|
||
|
OSSL_ASYNC_FD waitfd, void *custom)
|
||
|
{
|
||
|
close(waitfd);
|
||
|
}
|
||
|
|
||
|
static int afalg_setup_async_event_notification(afalg_aio *aio)
|
||
|
{
|
||
|
ASYNC_JOB *job;
|
||
|
ASYNC_WAIT_CTX *waitctx;
|
||
|
void *custom = NULL;
|
||
|
int ret;
|
||
|
|
||
|
if ((job = ASYNC_get_current_job()) != NULL) {
|
||
|
/* Async mode */
|
||
|
waitctx = ASYNC_get_wait_ctx(job);
|
||
|
if (waitctx == NULL) {
|
||
|
ALG_WARN("%s(%d): ASYNC_get_wait_ctx error", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
/* Get waitfd from ASYNC_WAIT_CTX if it is already set */
|
||
|
ret = ASYNC_WAIT_CTX_get_fd(waitctx, engine_afalg_id,
|
||
|
&aio->efd, &custom);
|
||
|
if (ret == 0) {
|
||
|
/*
|
||
|
* waitfd is not set in ASYNC_WAIT_CTX, create a new one
|
||
|
* and set it. efd will be signaled when AIO operation completes
|
||
|
*/
|
||
|
aio->efd = eventfd(0);
|
||
|
if (aio->efd == -1) {
|
||
|
ALG_PERR("%s(%d): Failed to get eventfd : ", __FILE__,
|
||
|
__LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_SETUP_ASYNC_EVENT_NOTIFICATION,
|
||
|
AFALG_R_EVENTFD_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
ret = ASYNC_WAIT_CTX_set_wait_fd(waitctx, engine_afalg_id,
|
||
|
aio->efd, custom,
|
||
|
afalg_waitfd_cleanup);
|
||
|
if (ret == 0) {
|
||
|
ALG_WARN("%s(%d): Failed to set wait fd", __FILE__, __LINE__);
|
||
|
close(aio->efd);
|
||
|
return 0;
|
||
|
}
|
||
|
/* make fd non-blocking in async mode */
|
||
|
if (fcntl(aio->efd, F_SETFL, O_NONBLOCK) != 0) {
|
||
|
ALG_WARN("%s(%d): Failed to set event fd as NONBLOCKING",
|
||
|
__FILE__, __LINE__);
|
||
|
}
|
||
|
}
|
||
|
aio->mode = MODE_ASYNC;
|
||
|
} else {
|
||
|
/* Sync mode */
|
||
|
aio->efd = eventfd(0);
|
||
|
if (aio->efd == -1) {
|
||
|
ALG_PERR("%s(%d): Failed to get eventfd : ", __FILE__, __LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_SETUP_ASYNC_EVENT_NOTIFICATION,
|
||
|
AFALG_R_EVENTFD_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
aio->mode = MODE_SYNC;
|
||
|
}
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_init_aio(afalg_aio *aio)
|
||
|
{
|
||
|
int r = -1;
|
||
|
|
||
|
/* Initialise for AIO */
|
||
|
aio->aio_ctx = 0;
|
||
|
r = io_setup(MAX_INFLIGHTS, &aio->aio_ctx);
|
||
|
if (r < 0) {
|
||
|
ALG_PERR("%s(%d): io_setup error : ", __FILE__, __LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_INIT_AIO, AFALG_R_IO_SETUP_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
memset(aio->cbt, 0, sizeof(aio->cbt));
|
||
|
aio->efd = -1;
|
||
|
aio->mode = MODE_UNINIT;
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_fin_cipher_aio(afalg_aio *aio, int sfd, unsigned char *buf,
|
||
|
size_t len)
|
||
|
{
|
||
|
int r;
|
||
|
int retry = 0;
|
||
|
unsigned int done = 0;
|
||
|
struct iocb *cb;
|
||
|
struct timespec timeout;
|
||
|
struct io_event events[MAX_INFLIGHTS];
|
||
|
u_int64_t eval = 0;
|
||
|
|
||
|
timeout.tv_sec = 0;
|
||
|
timeout.tv_nsec = 0;
|
||
|
|
||
|
/* if efd has not been initialised yet do it here */
|
||
|
if (aio->mode == MODE_UNINIT) {
|
||
|
r = afalg_setup_async_event_notification(aio);
|
||
|
if (r == 0)
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
cb = &(aio->cbt[0 % MAX_INFLIGHTS]);
|
||
|
memset(cb, '\0', sizeof(*cb));
|
||
|
cb->aio_fildes = sfd;
|
||
|
cb->aio_lio_opcode = IOCB_CMD_PREAD;
|
||
|
/*
|
||
|
* The pointer has to be converted to unsigned value first to avoid
|
||
|
* sign extension on cast to 64 bit value in 32-bit builds
|
||
|
*/
|
||
|
cb->aio_buf = (size_t)buf;
|
||
|
cb->aio_offset = 0;
|
||
|
cb->aio_data = 0;
|
||
|
cb->aio_nbytes = len;
|
||
|
cb->aio_flags = IOCB_FLAG_RESFD;
|
||
|
cb->aio_resfd = aio->efd;
|
||
|
|
||
|
/*
|
||
|
* Perform AIO read on AFALG socket, this in turn performs an async
|
||
|
* crypto operation in kernel space
|
||
|
*/
|
||
|
r = io_read(aio->aio_ctx, 1, &cb);
|
||
|
if (r < 0) {
|
||
|
ALG_PWARN("%s(%d): io_read failed : ", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
do {
|
||
|
/* While AIO read is being performed pause job */
|
||
|
ASYNC_pause_job();
|
||
|
|
||
|
/* Check for completion of AIO read */
|
||
|
r = read(aio->efd, &eval, sizeof(eval));
|
||
|
if (r < 0) {
|
||
|
if (errno == EAGAIN || errno == EWOULDBLOCK)
|
||
|
continue;
|
||
|
ALG_PERR("%s(%d): read failed for event fd : ", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
} else if (r == 0 || eval <= 0) {
|
||
|
ALG_WARN("%s(%d): eventfd read %d bytes, eval = %lu\n", __FILE__,
|
||
|
__LINE__, r, eval);
|
||
|
}
|
||
|
if (eval > 0) {
|
||
|
|
||
|
/* Get results of AIO read */
|
||
|
r = io_getevents(aio->aio_ctx, 1, MAX_INFLIGHTS,
|
||
|
events, &timeout);
|
||
|
if (r > 0) {
|
||
|
/*
|
||
|
* events.res indicates the actual status of the operation.
|
||
|
* Handle the error condition first.
|
||
|
*/
|
||
|
if (events[0].res < 0) {
|
||
|
/*
|
||
|
* Underlying operation cannot be completed at the time
|
||
|
* of previous submission. Resubmit for the operation.
|
||
|
*/
|
||
|
if (events[0].res == -EBUSY && retry++ < 3) {
|
||
|
r = io_read(aio->aio_ctx, 1, &cb);
|
||
|
if (r < 0) {
|
||
|
ALG_PERR("%s(%d): retry %d for io_read failed : ",
|
||
|
__FILE__, __LINE__, retry);
|
||
|
return 0;
|
||
|
}
|
||
|
continue;
|
||
|
} else {
|
||
|
/*
|
||
|
* Retries exceed for -EBUSY or unrecoverable error
|
||
|
* condition for this instance of operation.
|
||
|
*/
|
||
|
ALG_WARN
|
||
|
("%s(%d): Crypto Operation failed with code %lld\n",
|
||
|
__FILE__, __LINE__, events[0].res);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
/* Operation successful. */
|
||
|
done = 1;
|
||
|
} else if (r < 0) {
|
||
|
ALG_PERR("%s(%d): io_getevents failed : ", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
} else {
|
||
|
ALG_WARN("%s(%d): io_geteventd read 0 bytes\n", __FILE__,
|
||
|
__LINE__);
|
||
|
}
|
||
|
}
|
||
|
} while (!done);
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static ossl_inline void afalg_set_op_sk(struct cmsghdr *cmsg,
|
||
|
const ALG_OP_TYPE op)
|
||
|
{
|
||
|
cmsg->cmsg_level = SOL_ALG;
|
||
|
cmsg->cmsg_type = ALG_SET_OP;
|
||
|
cmsg->cmsg_len = CMSG_LEN(ALG_OP_LEN);
|
||
|
memcpy(CMSG_DATA(cmsg), &op, ALG_OP_LEN);
|
||
|
}
|
||
|
|
||
|
static void afalg_set_iv_sk(struct cmsghdr *cmsg, const unsigned char *iv,
|
||
|
const unsigned int len)
|
||
|
{
|
||
|
struct af_alg_iv *aiv;
|
||
|
|
||
|
cmsg->cmsg_level = SOL_ALG;
|
||
|
cmsg->cmsg_type = ALG_SET_IV;
|
||
|
cmsg->cmsg_len = CMSG_LEN(ALG_IV_LEN(len));
|
||
|
aiv = (struct af_alg_iv *)CMSG_DATA(cmsg);
|
||
|
aiv->ivlen = len;
|
||
|
memcpy(aiv->iv, iv, len);
|
||
|
}
|
||
|
|
||
|
static ossl_inline int afalg_set_key(afalg_ctx *actx, const unsigned char *key,
|
||
|
const int klen)
|
||
|
{
|
||
|
int ret;
|
||
|
ret = setsockopt(actx->bfd, SOL_ALG, ALG_SET_KEY, key, klen);
|
||
|
if (ret < 0) {
|
||
|
ALG_PERR("%s(%d): Failed to set socket option : ", __FILE__, __LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_SET_KEY, AFALG_R_SOCKET_SET_KEY_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_create_sk(afalg_ctx *actx, const char *ciphertype,
|
||
|
const char *ciphername)
|
||
|
{
|
||
|
struct sockaddr_alg sa;
|
||
|
int r = -1;
|
||
|
|
||
|
actx->bfd = actx->sfd = -1;
|
||
|
|
||
|
memset(&sa, 0, sizeof(sa));
|
||
|
sa.salg_family = AF_ALG;
|
||
|
OPENSSL_strlcpy((char *) sa.salg_type, ciphertype, sizeof(sa.salg_type));
|
||
|
OPENSSL_strlcpy((char *) sa.salg_name, ciphername, sizeof(sa.salg_name));
|
||
|
|
||
|
actx->bfd = socket(AF_ALG, SOCK_SEQPACKET, 0);
|
||
|
if (actx->bfd == -1) {
|
||
|
ALG_PERR("%s(%d): Failed to open socket : ", __FILE__, __LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_CREATE_SK, AFALG_R_SOCKET_CREATE_FAILED);
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
r = bind(actx->bfd, (struct sockaddr *)&sa, sizeof(sa));
|
||
|
if (r < 0) {
|
||
|
ALG_PERR("%s(%d): Failed to bind socket : ", __FILE__, __LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_CREATE_SK, AFALG_R_SOCKET_BIND_FAILED);
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
actx->sfd = accept(actx->bfd, NULL, 0);
|
||
|
if (actx->sfd < 0) {
|
||
|
ALG_PERR("%s(%d): Socket Accept Failed : ", __FILE__, __LINE__);
|
||
|
AFALGerr(AFALG_F_AFALG_CREATE_SK, AFALG_R_SOCKET_ACCEPT_FAILED);
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
|
||
|
err:
|
||
|
if (actx->bfd >= 0)
|
||
|
close(actx->bfd);
|
||
|
if (actx->sfd >= 0)
|
||
|
close(actx->sfd);
|
||
|
actx->bfd = actx->sfd = -1;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int afalg_start_cipher_sk(afalg_ctx *actx, const unsigned char *in,
|
||
|
size_t inl, const unsigned char *iv,
|
||
|
unsigned int enc)
|
||
|
{
|
||
|
struct msghdr msg = { 0 };
|
||
|
struct cmsghdr *cmsg;
|
||
|
struct iovec iov;
|
||
|
ssize_t sbytes;
|
||
|
# ifdef ALG_ZERO_COPY
|
||
|
int ret;
|
||
|
# endif
|
||
|
char cbuf[CMSG_SPACE(ALG_IV_LEN(ALG_AES_IV_LEN)) + CMSG_SPACE(ALG_OP_LEN)];
|
||
|
|
||
|
memset(cbuf, 0, sizeof(cbuf));
|
||
|
msg.msg_control = cbuf;
|
||
|
msg.msg_controllen = sizeof(cbuf);
|
||
|
|
||
|
/*
|
||
|
* cipher direction (i.e. encrypt or decrypt) and iv are sent to the
|
||
|
* kernel as part of sendmsg()'s ancillary data
|
||
|
*/
|
||
|
cmsg = CMSG_FIRSTHDR(&msg);
|
||
|
afalg_set_op_sk(cmsg, enc);
|
||
|
cmsg = CMSG_NXTHDR(&msg, cmsg);
|
||
|
afalg_set_iv_sk(cmsg, iv, ALG_AES_IV_LEN);
|
||
|
|
||
|
/* iov that describes input data */
|
||
|
iov.iov_base = (unsigned char *)in;
|
||
|
iov.iov_len = inl;
|
||
|
|
||
|
msg.msg_flags = MSG_MORE;
|
||
|
|
||
|
# ifdef ALG_ZERO_COPY
|
||
|
/*
|
||
|
* ZERO_COPY mode
|
||
|
* Works best when buffer is 4k aligned
|
||
|
* OPENS: out of place processing (i.e. out != in)
|
||
|
*/
|
||
|
|
||
|
/* Input data is not sent as part of call to sendmsg() */
|
||
|
msg.msg_iovlen = 0;
|
||
|
msg.msg_iov = NULL;
|
||
|
|
||
|
/* Sendmsg() sends iv and cipher direction to the kernel */
|
||
|
sbytes = sendmsg(actx->sfd, &msg, 0);
|
||
|
if (sbytes < 0) {
|
||
|
ALG_PERR("%s(%d): sendmsg failed for zero copy cipher operation : ",
|
||
|
__FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* vmsplice and splice are used to pin the user space input buffer for
|
||
|
* kernel space processing avoiding copies from user to kernel space
|
||
|
*/
|
||
|
ret = vmsplice(actx->zc_pipe[1], &iov, 1, SPLICE_F_GIFT);
|
||
|
if (ret < 0) {
|
||
|
ALG_PERR("%s(%d): vmsplice failed : ", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
ret = splice(actx->zc_pipe[0], NULL, actx->sfd, NULL, inl, 0);
|
||
|
if (ret < 0) {
|
||
|
ALG_PERR("%s(%d): splice failed : ", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
# else
|
||
|
msg.msg_iovlen = 1;
|
||
|
msg.msg_iov = &iov;
|
||
|
|
||
|
/* Sendmsg() sends iv, cipher direction and input data to the kernel */
|
||
|
sbytes = sendmsg(actx->sfd, &msg, 0);
|
||
|
if (sbytes < 0) {
|
||
|
ALG_PERR("%s(%d): sendmsg failed for cipher operation : ", __FILE__,
|
||
|
__LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if (sbytes != (ssize_t) inl) {
|
||
|
ALG_WARN("Cipher operation send bytes %zd != inlen %zd\n", sbytes,
|
||
|
inl);
|
||
|
return 0;
|
||
|
}
|
||
|
# endif
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_cipher_init(EVP_CIPHER_CTX *ctx, const unsigned char *key,
|
||
|
const unsigned char *iv, int enc)
|
||
|
{
|
||
|
int ciphertype;
|
||
|
int ret;
|
||
|
afalg_ctx *actx;
|
||
|
const char *ciphername;
|
||
|
|
||
|
if (ctx == NULL || key == NULL) {
|
||
|
ALG_WARN("%s(%d): Null Parameter\n", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if (EVP_CIPHER_CTX_cipher(ctx) == NULL) {
|
||
|
ALG_WARN("%s(%d): Cipher object NULL\n", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
actx = EVP_CIPHER_CTX_get_cipher_data(ctx);
|
||
|
if (actx == NULL) {
|
||
|
ALG_WARN("%s(%d): Cipher data NULL\n", __FILE__, __LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
ciphertype = EVP_CIPHER_CTX_nid(ctx);
|
||
|
switch (ciphertype) {
|
||
|
case NID_aes_128_cbc:
|
||
|
case NID_aes_192_cbc:
|
||
|
case NID_aes_256_cbc:
|
||
|
ciphername = "cbc(aes)";
|
||
|
break;
|
||
|
default:
|
||
|
ALG_WARN("%s(%d): Unsupported Cipher type %d\n", __FILE__, __LINE__,
|
||
|
ciphertype);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if (ALG_AES_IV_LEN != EVP_CIPHER_CTX_iv_length(ctx)) {
|
||
|
ALG_WARN("%s(%d): Unsupported IV length :%d\n", __FILE__, __LINE__,
|
||
|
EVP_CIPHER_CTX_iv_length(ctx));
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* Setup AFALG socket for crypto processing */
|
||
|
ret = afalg_create_sk(actx, "skcipher", ciphername);
|
||
|
if (ret < 1)
|
||
|
return 0;
|
||
|
|
||
|
|
||
|
ret = afalg_set_key(actx, key, EVP_CIPHER_CTX_key_length(ctx));
|
||
|
if (ret < 1)
|
||
|
goto err;
|
||
|
|
||
|
/* Setup AIO ctx to allow async AFALG crypto processing */
|
||
|
if (afalg_init_aio(&actx->aio) == 0)
|
||
|
goto err;
|
||
|
|
||
|
# ifdef ALG_ZERO_COPY
|
||
|
pipe(actx->zc_pipe);
|
||
|
# endif
|
||
|
|
||
|
actx->init_done = MAGIC_INIT_NUM;
|
||
|
|
||
|
return 1;
|
||
|
|
||
|
err:
|
||
|
close(actx->sfd);
|
||
|
close(actx->bfd);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int afalg_do_cipher(EVP_CIPHER_CTX *ctx, unsigned char *out,
|
||
|
const unsigned char *in, size_t inl)
|
||
|
{
|
||
|
afalg_ctx *actx;
|
||
|
int ret;
|
||
|
char nxtiv[ALG_AES_IV_LEN] = { 0 };
|
||
|
|
||
|
if (ctx == NULL || out == NULL || in == NULL) {
|
||
|
ALG_WARN("NULL parameter passed to function %s(%d)\n", __FILE__,
|
||
|
__LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
actx = (afalg_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx);
|
||
|
if (actx == NULL || actx->init_done != MAGIC_INIT_NUM) {
|
||
|
ALG_WARN("%s afalg ctx passed\n",
|
||
|
ctx == NULL ? "NULL" : "Uninitialised");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* set iv now for decrypt operation as the input buffer can be
|
||
|
* overwritten for inplace operation where in = out.
|
||
|
*/
|
||
|
if (EVP_CIPHER_CTX_encrypting(ctx) == 0) {
|
||
|
memcpy(nxtiv, in + (inl - ALG_AES_IV_LEN), ALG_AES_IV_LEN);
|
||
|
}
|
||
|
|
||
|
/* Send input data to kernel space */
|
||
|
ret = afalg_start_cipher_sk(actx, (unsigned char *)in, inl,
|
||
|
EVP_CIPHER_CTX_iv(ctx),
|
||
|
EVP_CIPHER_CTX_encrypting(ctx));
|
||
|
if (ret < 1) {
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* Perform async crypto operation in kernel space */
|
||
|
ret = afalg_fin_cipher_aio(&actx->aio, actx->sfd, out, inl);
|
||
|
if (ret < 1)
|
||
|
return 0;
|
||
|
|
||
|
if (EVP_CIPHER_CTX_encrypting(ctx)) {
|
||
|
memcpy(EVP_CIPHER_CTX_iv_noconst(ctx), out + (inl - ALG_AES_IV_LEN),
|
||
|
ALG_AES_IV_LEN);
|
||
|
} else {
|
||
|
memcpy(EVP_CIPHER_CTX_iv_noconst(ctx), nxtiv, ALG_AES_IV_LEN);
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_cipher_cleanup(EVP_CIPHER_CTX *ctx)
|
||
|
{
|
||
|
afalg_ctx *actx;
|
||
|
|
||
|
if (ctx == NULL) {
|
||
|
ALG_WARN("NULL parameter passed to function %s(%d)\n", __FILE__,
|
||
|
__LINE__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
actx = (afalg_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx);
|
||
|
if (actx == NULL || actx->init_done != MAGIC_INIT_NUM)
|
||
|
return 1;
|
||
|
|
||
|
close(actx->sfd);
|
||
|
close(actx->bfd);
|
||
|
# ifdef ALG_ZERO_COPY
|
||
|
close(actx->zc_pipe[0]);
|
||
|
close(actx->zc_pipe[1]);
|
||
|
# endif
|
||
|
/* close efd in sync mode, async mode is closed in afalg_waitfd_cleanup() */
|
||
|
if (actx->aio.mode == MODE_SYNC)
|
||
|
close(actx->aio.efd);
|
||
|
io_destroy(actx->aio.aio_ctx);
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static cbc_handles *get_cipher_handle(int nid)
|
||
|
{
|
||
|
switch (nid) {
|
||
|
case NID_aes_128_cbc:
|
||
|
return &cbc_handle[AES_CBC_128];
|
||
|
case NID_aes_192_cbc:
|
||
|
return &cbc_handle[AES_CBC_192];
|
||
|
case NID_aes_256_cbc:
|
||
|
return &cbc_handle[AES_CBC_256];
|
||
|
default:
|
||
|
return NULL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static const EVP_CIPHER *afalg_aes_cbc(int nid)
|
||
|
{
|
||
|
cbc_handles *cipher_handle = get_cipher_handle(nid);
|
||
|
if (cipher_handle->_hidden == NULL
|
||
|
&& ((cipher_handle->_hidden =
|
||
|
EVP_CIPHER_meth_new(nid,
|
||
|
AES_BLOCK_SIZE,
|
||
|
cipher_handle->key_size)) == NULL
|
||
|
|| !EVP_CIPHER_meth_set_iv_length(cipher_handle->_hidden,
|
||
|
AES_IV_LEN)
|
||
|
|| !EVP_CIPHER_meth_set_flags(cipher_handle->_hidden,
|
||
|
EVP_CIPH_CBC_MODE |
|
||
|
EVP_CIPH_FLAG_DEFAULT_ASN1)
|
||
|
|| !EVP_CIPHER_meth_set_init(cipher_handle->_hidden,
|
||
|
afalg_cipher_init)
|
||
|
|| !EVP_CIPHER_meth_set_do_cipher(cipher_handle->_hidden,
|
||
|
afalg_do_cipher)
|
||
|
|| !EVP_CIPHER_meth_set_cleanup(cipher_handle->_hidden,
|
||
|
afalg_cipher_cleanup)
|
||
|
|| !EVP_CIPHER_meth_set_impl_ctx_size(cipher_handle->_hidden,
|
||
|
sizeof(afalg_ctx)))) {
|
||
|
EVP_CIPHER_meth_free(cipher_handle->_hidden);
|
||
|
cipher_handle->_hidden= NULL;
|
||
|
}
|
||
|
return cipher_handle->_hidden;
|
||
|
}
|
||
|
|
||
|
static int afalg_ciphers(ENGINE *e, const EVP_CIPHER **cipher,
|
||
|
const int **nids, int nid)
|
||
|
{
|
||
|
int r = 1;
|
||
|
|
||
|
if (cipher == NULL) {
|
||
|
*nids = afalg_cipher_nids;
|
||
|
return (sizeof(afalg_cipher_nids) / sizeof(afalg_cipher_nids[0]));
|
||
|
}
|
||
|
|
||
|
switch (nid) {
|
||
|
case NID_aes_128_cbc:
|
||
|
case NID_aes_192_cbc:
|
||
|
case NID_aes_256_cbc:
|
||
|
*cipher = afalg_aes_cbc(nid);
|
||
|
break;
|
||
|
default:
|
||
|
*cipher = NULL;
|
||
|
r = 0;
|
||
|
}
|
||
|
return r;
|
||
|
}
|
||
|
|
||
|
static int bind_afalg(ENGINE *e)
|
||
|
{
|
||
|
/* Ensure the afalg error handling is set up */
|
||
|
unsigned short i;
|
||
|
ERR_load_AFALG_strings();
|
||
|
|
||
|
if (!ENGINE_set_id(e, engine_afalg_id)
|
||
|
|| !ENGINE_set_name(e, engine_afalg_name)
|
||
|
|| !ENGINE_set_destroy_function(e, afalg_destroy)
|
||
|
|| !ENGINE_set_init_function(e, afalg_init)
|
||
|
|| !ENGINE_set_finish_function(e, afalg_finish)) {
|
||
|
AFALGerr(AFALG_F_BIND_AFALG, AFALG_R_INIT_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Create _hidden_aes_xxx_cbc by calling afalg_aes_xxx_cbc
|
||
|
* now, as bind_aflag can only be called by one thread at a
|
||
|
* time.
|
||
|
*/
|
||
|
for(i = 0; i < OSSL_NELEM(afalg_cipher_nids); i++) {
|
||
|
if (afalg_aes_cbc(afalg_cipher_nids[i]) == NULL) {
|
||
|
AFALGerr(AFALG_F_BIND_AFALG, AFALG_R_INIT_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (!ENGINE_set_ciphers(e, afalg_ciphers)) {
|
||
|
AFALGerr(AFALG_F_BIND_AFALG, AFALG_R_INIT_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
# ifndef OPENSSL_NO_DYNAMIC_ENGINE
|
||
|
static int bind_helper(ENGINE *e, const char *id)
|
||
|
{
|
||
|
if (id && (strcmp(id, engine_afalg_id) != 0))
|
||
|
return 0;
|
||
|
|
||
|
if (!afalg_chk_platform())
|
||
|
return 0;
|
||
|
|
||
|
if (!bind_afalg(e))
|
||
|
return 0;
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
IMPLEMENT_DYNAMIC_CHECK_FN()
|
||
|
IMPLEMENT_DYNAMIC_BIND_FN(bind_helper)
|
||
|
# endif
|
||
|
|
||
|
static int afalg_chk_platform(void)
|
||
|
{
|
||
|
int ret;
|
||
|
int i;
|
||
|
int kver[3] = { -1, -1, -1 };
|
||
|
int sock;
|
||
|
char *str;
|
||
|
struct utsname ut;
|
||
|
|
||
|
ret = uname(&ut);
|
||
|
if (ret != 0) {
|
||
|
AFALGerr(AFALG_F_AFALG_CHK_PLATFORM,
|
||
|
AFALG_R_FAILED_TO_GET_PLATFORM_INFO);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
str = strtok(ut.release, ".");
|
||
|
for (i = 0; i < 3 && str != NULL; i++) {
|
||
|
kver[i] = atoi(str);
|
||
|
str = strtok(NULL, ".");
|
||
|
}
|
||
|
|
||
|
if (KERNEL_VERSION(kver[0], kver[1], kver[2])
|
||
|
< KERNEL_VERSION(K_MAJ, K_MIN1, K_MIN2)) {
|
||
|
ALG_ERR("ASYNC AFALG not supported this kernel(%d.%d.%d)\n",
|
||
|
kver[0], kver[1], kver[2]);
|
||
|
ALG_ERR("ASYNC AFALG requires kernel version %d.%d.%d or later\n",
|
||
|
K_MAJ, K_MIN1, K_MIN2);
|
||
|
AFALGerr(AFALG_F_AFALG_CHK_PLATFORM,
|
||
|
AFALG_R_KERNEL_DOES_NOT_SUPPORT_ASYNC_AFALG);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* Test if we can actually create an AF_ALG socket */
|
||
|
sock = socket(AF_ALG, SOCK_SEQPACKET, 0);
|
||
|
if (sock == -1) {
|
||
|
AFALGerr(AFALG_F_AFALG_CHK_PLATFORM, AFALG_R_SOCKET_CREATE_FAILED);
|
||
|
return 0;
|
||
|
}
|
||
|
close(sock);
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
# ifdef OPENSSL_NO_DYNAMIC_ENGINE
|
||
|
static ENGINE *engine_afalg(void)
|
||
|
{
|
||
|
ENGINE *ret = ENGINE_new();
|
||
|
if (ret == NULL)
|
||
|
return NULL;
|
||
|
if (!bind_afalg(ret)) {
|
||
|
ENGINE_free(ret);
|
||
|
return NULL;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
void engine_load_afalg_int(void)
|
||
|
{
|
||
|
ENGINE *toadd;
|
||
|
|
||
|
if (!afalg_chk_platform())
|
||
|
return;
|
||
|
|
||
|
toadd = engine_afalg();
|
||
|
if (toadd == NULL)
|
||
|
return;
|
||
|
ENGINE_add(toadd);
|
||
|
ENGINE_free(toadd);
|
||
|
ERR_clear_error();
|
||
|
}
|
||
|
# endif
|
||
|
|
||
|
static int afalg_init(ENGINE *e)
|
||
|
{
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_finish(ENGINE *e)
|
||
|
{
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int free_cbc(void)
|
||
|
{
|
||
|
short unsigned int i;
|
||
|
for(i = 0; i < OSSL_NELEM(afalg_cipher_nids); i++) {
|
||
|
EVP_CIPHER_meth_free(cbc_handle[i]._hidden);
|
||
|
cbc_handle[i]._hidden = NULL;
|
||
|
}
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int afalg_destroy(ENGINE *e)
|
||
|
{
|
||
|
ERR_unload_AFALG_strings();
|
||
|
free_cbc();
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
#endif /* KERNEL VERSION */
|