| /* |
| * algif_skcipher: User-space interface for skcipher algorithms |
| * |
| * This file provides the user-space API for symmetric key ciphers. |
| * |
| * Copyright (c) 2010 Herbert Xu <herbert@gondor.apana.org.au> |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the Free |
| * Software Foundation; either version 2 of the License, or (at your option) |
| * any later version. |
| * |
| */ |
| |
| #include <crypto/scatterwalk.h> |
| #include <crypto/skcipher.h> |
| #include <crypto/if_alg.h> |
| #include <linux/init.h> |
| #include <linux/list.h> |
| #include <linux/kernel.h> |
| #include <linux/mm.h> |
| #include <linux/module.h> |
| #include <linux/net.h> |
| #include <net/sock.h> |
| |
| struct skcipher_sg_list { |
| struct list_head list; |
| |
| int cur; |
| |
| struct scatterlist sg[0]; |
| }; |
| |
| struct skcipher_tfm { |
| struct crypto_skcipher *skcipher; |
| bool has_key; |
| }; |
| |
| struct skcipher_ctx { |
| struct list_head tsgl; |
| struct af_alg_sgl rsgl; |
| |
| void *iv; |
| |
| struct af_alg_completion completion; |
| |
| atomic_t inflight; |
| size_t used; |
| |
| unsigned int len; |
| bool more; |
| bool merge; |
| bool enc; |
| |
| struct skcipher_request req; |
| }; |
| |
| struct skcipher_async_rsgl { |
| struct af_alg_sgl sgl; |
| struct list_head list; |
| }; |
| |
| struct skcipher_async_req { |
| struct kiocb *iocb; |
| struct skcipher_async_rsgl first_sgl; |
| struct list_head list; |
| struct scatterlist *tsg; |
| atomic_t *inflight; |
| struct skcipher_request req; |
| }; |
| |
| #define MAX_SGL_ENTS ((4096 - sizeof(struct skcipher_sg_list)) / \ |
| sizeof(struct scatterlist) - 1) |
| |
| static void skcipher_free_async_sgls(struct skcipher_async_req *sreq) |
| { |
| struct skcipher_async_rsgl *rsgl, *tmp; |
| struct scatterlist *sgl; |
| struct scatterlist *sg; |
| int i, n; |
| |
| list_for_each_entry_safe(rsgl, tmp, &sreq->list, list) { |
| af_alg_free_sg(&rsgl->sgl); |
| if (rsgl != &sreq->first_sgl) |
| kfree(rsgl); |
| } |
| sgl = sreq->tsg; |
| n = sg_nents(sgl); |
| for_each_sg(sgl, sg, n, i) |
| put_page(sg_page(sg)); |
| |
| kfree(sreq->tsg); |
| } |
| |
| static void skcipher_async_cb(struct crypto_async_request *req, int err) |
| { |
| struct skcipher_async_req *sreq = req->data; |
| struct kiocb *iocb = sreq->iocb; |
| |
| atomic_dec(sreq->inflight); |
| skcipher_free_async_sgls(sreq); |
| kzfree(sreq); |
| iocb->ki_complete(iocb, err, err); |
| } |
| |
| static inline int skcipher_sndbuf(struct sock *sk) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| |
| return max_t(int, max_t(int, sk->sk_sndbuf & PAGE_MASK, PAGE_SIZE) - |
| ctx->used, 0); |
| } |
| |
| static inline bool skcipher_writable(struct sock *sk) |
| { |
| return PAGE_SIZE <= skcipher_sndbuf(sk); |
| } |
| |
| static int skcipher_alloc_sgl(struct sock *sk) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct skcipher_sg_list *sgl; |
| struct scatterlist *sg = NULL; |
| |
| sgl = list_entry(ctx->tsgl.prev, struct skcipher_sg_list, list); |
| if (!list_empty(&ctx->tsgl)) |
| sg = sgl->sg; |
| |
| if (!sg || sgl->cur >= MAX_SGL_ENTS) { |
| sgl = sock_kmalloc(sk, sizeof(*sgl) + |
| sizeof(sgl->sg[0]) * (MAX_SGL_ENTS + 1), |
| GFP_KERNEL); |
| if (!sgl) |
| return -ENOMEM; |
| |
| sg_init_table(sgl->sg, MAX_SGL_ENTS + 1); |
| sgl->cur = 0; |
| |
| if (sg) |
| sg_chain(sg, MAX_SGL_ENTS + 1, sgl->sg); |
| |
| list_add_tail(&sgl->list, &ctx->tsgl); |
| } |
| |
| return 0; |
| } |
| |
| static void skcipher_pull_sgl(struct sock *sk, size_t used, int put) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct skcipher_sg_list *sgl; |
| struct scatterlist *sg; |
| int i; |
| |
| while (!list_empty(&ctx->tsgl)) { |
| sgl = list_first_entry(&ctx->tsgl, struct skcipher_sg_list, |
| list); |
| sg = sgl->sg; |
| |
| for (i = 0; i < sgl->cur; i++) { |
| size_t plen = min_t(size_t, used, sg[i].length); |
| |
| if (!sg_page(sg + i)) |
| continue; |
| |
| sg[i].length -= plen; |
| sg[i].offset += plen; |
| |
| used -= plen; |
| ctx->used -= plen; |
| |
| if (sg[i].length) |
| return; |
| if (put) |
| put_page(sg_page(sg + i)); |
| sg_assign_page(sg + i, NULL); |
| } |
| |
| list_del(&sgl->list); |
| sock_kfree_s(sk, sgl, |
| sizeof(*sgl) + sizeof(sgl->sg[0]) * |
| (MAX_SGL_ENTS + 1)); |
| } |
| |
| if (!ctx->used) |
| ctx->merge = 0; |
| } |
| |
| static void skcipher_free_sgl(struct sock *sk) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| |
| skcipher_pull_sgl(sk, ctx->used, 1); |
| } |
| |
| static int skcipher_wait_for_wmem(struct sock *sk, unsigned flags) |
| { |
| long timeout; |
| DEFINE_WAIT(wait); |
| int err = -ERESTARTSYS; |
| |
| if (flags & MSG_DONTWAIT) |
| return -EAGAIN; |
| |
| sk_set_bit(SOCKWQ_ASYNC_NOSPACE, sk); |
| |
| for (;;) { |
| if (signal_pending(current)) |
| break; |
| prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); |
| timeout = MAX_SCHEDULE_TIMEOUT; |
| if (sk_wait_event(sk, &timeout, skcipher_writable(sk))) { |
| err = 0; |
| break; |
| } |
| } |
| finish_wait(sk_sleep(sk), &wait); |
| |
| return err; |
| } |
| |
| static void skcipher_wmem_wakeup(struct sock *sk) |
| { |
| struct socket_wq *wq; |
| |
| if (!skcipher_writable(sk)) |
| return; |
| |
| rcu_read_lock(); |
| wq = rcu_dereference(sk->sk_wq); |
| if (skwq_has_sleeper(wq)) |
| wake_up_interruptible_sync_poll(&wq->wait, POLLIN | |
| POLLRDNORM | |
| POLLRDBAND); |
| sk_wake_async(sk, SOCK_WAKE_WAITD, POLL_IN); |
| rcu_read_unlock(); |
| } |
| |
| static int skcipher_wait_for_data(struct sock *sk, unsigned flags) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| long timeout; |
| DEFINE_WAIT(wait); |
| int err = -ERESTARTSYS; |
| |
| if (flags & MSG_DONTWAIT) { |
| return -EAGAIN; |
| } |
| |
| sk_set_bit(SOCKWQ_ASYNC_WAITDATA, sk); |
| |
| for (;;) { |
| if (signal_pending(current)) |
| break; |
| prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); |
| timeout = MAX_SCHEDULE_TIMEOUT; |
| if (sk_wait_event(sk, &timeout, ctx->used)) { |
| err = 0; |
| break; |
| } |
| } |
| finish_wait(sk_sleep(sk), &wait); |
| |
| sk_clear_bit(SOCKWQ_ASYNC_WAITDATA, sk); |
| |
| return err; |
| } |
| |
| static void skcipher_data_wakeup(struct sock *sk) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct socket_wq *wq; |
| |
| if (!ctx->used) |
| return; |
| |
| rcu_read_lock(); |
| wq = rcu_dereference(sk->sk_wq); |
| if (skwq_has_sleeper(wq)) |
| wake_up_interruptible_sync_poll(&wq->wait, POLLOUT | |
| POLLRDNORM | |
| POLLRDBAND); |
| sk_wake_async(sk, SOCK_WAKE_SPACE, POLL_OUT); |
| rcu_read_unlock(); |
| } |
| |
| static int skcipher_sendmsg(struct socket *sock, struct msghdr *msg, |
| size_t size) |
| { |
| struct sock *sk = sock->sk; |
| struct alg_sock *ask = alg_sk(sk); |
| struct sock *psk = ask->parent; |
| struct alg_sock *pask = alg_sk(psk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct skcipher_tfm *skc = pask->private; |
| struct crypto_skcipher *tfm = skc->skcipher; |
| unsigned ivsize = crypto_skcipher_ivsize(tfm); |
| struct skcipher_sg_list *sgl; |
| struct af_alg_control con = {}; |
| long copied = 0; |
| bool enc = 0; |
| bool init = 0; |
| int err; |
| int i; |
| |
| if (msg->msg_controllen) { |
| err = af_alg_cmsg_send(msg, &con); |
| if (err) |
| return err; |
| |
| init = 1; |
| switch (con.op) { |
| case ALG_OP_ENCRYPT: |
| enc = 1; |
| break; |
| case ALG_OP_DECRYPT: |
| enc = 0; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| if (con.iv && con.iv->ivlen != ivsize) |
| return -EINVAL; |
| } |
| |
| err = -EINVAL; |
| |
| lock_sock(sk); |
| if (!ctx->more && ctx->used) |
| goto unlock; |
| |
| if (init) { |
| ctx->enc = enc; |
| if (con.iv) |
| memcpy(ctx->iv, con.iv->iv, ivsize); |
| } |
| |
| while (size) { |
| struct scatterlist *sg; |
| unsigned long len = size; |
| size_t plen; |
| |
| if (ctx->merge) { |
| sgl = list_entry(ctx->tsgl.prev, |
| struct skcipher_sg_list, list); |
| sg = sgl->sg + sgl->cur - 1; |
| len = min_t(unsigned long, len, |
| PAGE_SIZE - sg->offset - sg->length); |
| |
| err = memcpy_from_msg(page_address(sg_page(sg)) + |
| sg->offset + sg->length, |
| msg, len); |
| if (err) |
| goto unlock; |
| |
| sg->length += len; |
| ctx->merge = (sg->offset + sg->length) & |
| (PAGE_SIZE - 1); |
| |
| ctx->used += len; |
| copied += len; |
| size -= len; |
| continue; |
| } |
| |
| if (!skcipher_writable(sk)) { |
| err = skcipher_wait_for_wmem(sk, msg->msg_flags); |
| if (err) |
| goto unlock; |
| } |
| |
| len = min_t(unsigned long, len, skcipher_sndbuf(sk)); |
| |
| err = skcipher_alloc_sgl(sk); |
| if (err) |
| goto unlock; |
| |
| sgl = list_entry(ctx->tsgl.prev, struct skcipher_sg_list, list); |
| sg = sgl->sg; |
| if (sgl->cur) |
| sg_unmark_end(sg + sgl->cur - 1); |
| do { |
| i = sgl->cur; |
| plen = min_t(size_t, len, PAGE_SIZE); |
| |
| sg_assign_page(sg + i, alloc_page(GFP_KERNEL)); |
| err = -ENOMEM; |
| if (!sg_page(sg + i)) |
| goto unlock; |
| |
| err = memcpy_from_msg(page_address(sg_page(sg + i)), |
| msg, plen); |
| if (err) { |
| __free_page(sg_page(sg + i)); |
| sg_assign_page(sg + i, NULL); |
| goto unlock; |
| } |
| |
| sg[i].length = plen; |
| len -= plen; |
| ctx->used += plen; |
| copied += plen; |
| size -= plen; |
| sgl->cur++; |
| } while (len && sgl->cur < MAX_SGL_ENTS); |
| |
| if (!size) |
| sg_mark_end(sg + sgl->cur - 1); |
| |
| ctx->merge = plen & (PAGE_SIZE - 1); |
| } |
| |
| err = 0; |
| |
| ctx->more = msg->msg_flags & MSG_MORE; |
| |
| unlock: |
| skcipher_data_wakeup(sk); |
| release_sock(sk); |
| |
| return copied ?: err; |
| } |
| |
| static ssize_t skcipher_sendpage(struct socket *sock, struct page *page, |
| int offset, size_t size, int flags) |
| { |
| struct sock *sk = sock->sk; |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct skcipher_sg_list *sgl; |
| int err = -EINVAL; |
| |
| if (flags & MSG_SENDPAGE_NOTLAST) |
| flags |= MSG_MORE; |
| |
| lock_sock(sk); |
| if (!ctx->more && ctx->used) |
| goto unlock; |
| |
| if (!size) |
| goto done; |
| |
| if (!skcipher_writable(sk)) { |
| err = skcipher_wait_for_wmem(sk, flags); |
| if (err) |
| goto unlock; |
| } |
| |
| err = skcipher_alloc_sgl(sk); |
| if (err) |
| goto unlock; |
| |
| ctx->merge = 0; |
| sgl = list_entry(ctx->tsgl.prev, struct skcipher_sg_list, list); |
| |
| if (sgl->cur) |
| sg_unmark_end(sgl->sg + sgl->cur - 1); |
| |
| sg_mark_end(sgl->sg + sgl->cur); |
| get_page(page); |
| sg_set_page(sgl->sg + sgl->cur, page, size, offset); |
| sgl->cur++; |
| ctx->used += size; |
| |
| done: |
| ctx->more = flags & MSG_MORE; |
| |
| unlock: |
| skcipher_data_wakeup(sk); |
| release_sock(sk); |
| |
| return err ?: size; |
| } |
| |
| static int skcipher_all_sg_nents(struct skcipher_ctx *ctx) |
| { |
| struct skcipher_sg_list *sgl; |
| struct scatterlist *sg; |
| int nents = 0; |
| |
| list_for_each_entry(sgl, &ctx->tsgl, list) { |
| sg = sgl->sg; |
| |
| while (!sg->length) |
| sg++; |
| |
| nents += sg_nents(sg); |
| } |
| return nents; |
| } |
| |
| static int skcipher_recvmsg_async(struct socket *sock, struct msghdr *msg, |
| int flags) |
| { |
| struct sock *sk = sock->sk; |
| struct alg_sock *ask = alg_sk(sk); |
| struct sock *psk = ask->parent; |
| struct alg_sock *pask = alg_sk(psk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct skcipher_tfm *skc = pask->private; |
| struct crypto_skcipher *tfm = skc->skcipher; |
| struct skcipher_sg_list *sgl; |
| struct scatterlist *sg; |
| struct skcipher_async_req *sreq; |
| struct skcipher_request *req; |
| struct skcipher_async_rsgl *last_rsgl = NULL; |
| unsigned int txbufs = 0, len = 0, tx_nents; |
| unsigned int reqsize = crypto_skcipher_reqsize(tfm); |
| unsigned int ivsize = crypto_skcipher_ivsize(tfm); |
| int err = -ENOMEM; |
| bool mark = false; |
| char *iv; |
| |
| sreq = kzalloc(sizeof(*sreq) + reqsize + ivsize, GFP_KERNEL); |
| if (unlikely(!sreq)) |
| goto out; |
| |
| req = &sreq->req; |
| iv = (char *)(req + 1) + reqsize; |
| sreq->iocb = msg->msg_iocb; |
| INIT_LIST_HEAD(&sreq->list); |
| sreq->inflight = &ctx->inflight; |
| |
| lock_sock(sk); |
| tx_nents = skcipher_all_sg_nents(ctx); |
| sreq->tsg = kcalloc(tx_nents, sizeof(*sg), GFP_KERNEL); |
| if (unlikely(!sreq->tsg)) |
| goto unlock; |
| sg_init_table(sreq->tsg, tx_nents); |
| memcpy(iv, ctx->iv, ivsize); |
| skcipher_request_set_tfm(req, tfm); |
| skcipher_request_set_callback(req, CRYPTO_TFM_REQ_MAY_SLEEP, |
| skcipher_async_cb, sreq); |
| |
| while (iov_iter_count(&msg->msg_iter)) { |
| struct skcipher_async_rsgl *rsgl; |
| int used; |
| |
| if (!ctx->used) { |
| err = skcipher_wait_for_data(sk, flags); |
| if (err) |
| goto free; |
| } |
| sgl = list_first_entry(&ctx->tsgl, |
| struct skcipher_sg_list, list); |
| sg = sgl->sg; |
| |
| while (!sg->length) |
| sg++; |
| |
| used = min_t(unsigned long, ctx->used, |
| iov_iter_count(&msg->msg_iter)); |
| used = min_t(unsigned long, used, sg->length); |
| |
| if (txbufs == tx_nents) { |
| struct scatterlist *tmp; |
| int x; |
| /* Ran out of tx slots in async request |
| * need to expand */ |
| tmp = kcalloc(tx_nents * 2, sizeof(*tmp), |
| GFP_KERNEL); |
| if (!tmp) |
| goto free; |
| |
| sg_init_table(tmp, tx_nents * 2); |
| for (x = 0; x < tx_nents; x++) |
| sg_set_page(&tmp[x], sg_page(&sreq->tsg[x]), |
| sreq->tsg[x].length, |
| sreq->tsg[x].offset); |
| kfree(sreq->tsg); |
| sreq->tsg = tmp; |
| tx_nents *= 2; |
| mark = true; |
| } |
| /* Need to take over the tx sgl from ctx |
| * to the asynch req - these sgls will be freed later */ |
| sg_set_page(sreq->tsg + txbufs++, sg_page(sg), sg->length, |
| sg->offset); |
| |
| if (list_empty(&sreq->list)) { |
| rsgl = &sreq->first_sgl; |
| list_add_tail(&rsgl->list, &sreq->list); |
| } else { |
| rsgl = kmalloc(sizeof(*rsgl), GFP_KERNEL); |
| if (!rsgl) { |
| err = -ENOMEM; |
| goto free; |
| } |
| list_add_tail(&rsgl->list, &sreq->list); |
| } |
| |
| used = af_alg_make_sg(&rsgl->sgl, &msg->msg_iter, used); |
| err = used; |
| if (used < 0) |
| goto free; |
| if (last_rsgl) |
| af_alg_link_sg(&last_rsgl->sgl, &rsgl->sgl); |
| |
| last_rsgl = rsgl; |
| len += used; |
| skcipher_pull_sgl(sk, used, 0); |
| iov_iter_advance(&msg->msg_iter, used); |
| } |
| |
| if (mark) |
| sg_mark_end(sreq->tsg + txbufs - 1); |
| |
| skcipher_request_set_crypt(req, sreq->tsg, sreq->first_sgl.sgl.sg, |
| len, iv); |
| err = ctx->enc ? crypto_skcipher_encrypt(req) : |
| crypto_skcipher_decrypt(req); |
| if (err == -EINPROGRESS) { |
| atomic_inc(&ctx->inflight); |
| err = -EIOCBQUEUED; |
| sreq = NULL; |
| goto unlock; |
| } |
| free: |
| skcipher_free_async_sgls(sreq); |
| unlock: |
| skcipher_wmem_wakeup(sk); |
| release_sock(sk); |
| kzfree(sreq); |
| out: |
| return err; |
| } |
| |
| static int skcipher_recvmsg_sync(struct socket *sock, struct msghdr *msg, |
| int flags) |
| { |
| struct sock *sk = sock->sk; |
| struct alg_sock *ask = alg_sk(sk); |
| struct sock *psk = ask->parent; |
| struct alg_sock *pask = alg_sk(psk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct skcipher_tfm *skc = pask->private; |
| struct crypto_skcipher *tfm = skc->skcipher; |
| unsigned bs = crypto_skcipher_blocksize(tfm); |
| struct skcipher_sg_list *sgl; |
| struct scatterlist *sg; |
| int err = -EAGAIN; |
| int used; |
| long copied = 0; |
| |
| lock_sock(sk); |
| while (msg_data_left(msg)) { |
| if (!ctx->used) { |
| err = skcipher_wait_for_data(sk, flags); |
| if (err) |
| goto unlock; |
| } |
| |
| used = min_t(unsigned long, ctx->used, msg_data_left(msg)); |
| |
| used = af_alg_make_sg(&ctx->rsgl, &msg->msg_iter, used); |
| err = used; |
| if (err < 0) |
| goto unlock; |
| |
| if (ctx->more || used < ctx->used) |
| used -= used % bs; |
| |
| err = -EINVAL; |
| if (!used) |
| goto free; |
| |
| sgl = list_first_entry(&ctx->tsgl, |
| struct skcipher_sg_list, list); |
| sg = sgl->sg; |
| |
| while (!sg->length) |
| sg++; |
| |
| skcipher_request_set_crypt(&ctx->req, sg, ctx->rsgl.sg, used, |
| ctx->iv); |
| |
| err = af_alg_wait_for_completion( |
| ctx->enc ? |
| crypto_skcipher_encrypt(&ctx->req) : |
| crypto_skcipher_decrypt(&ctx->req), |
| &ctx->completion); |
| |
| free: |
| af_alg_free_sg(&ctx->rsgl); |
| |
| if (err) |
| goto unlock; |
| |
| copied += used; |
| skcipher_pull_sgl(sk, used, 1); |
| iov_iter_advance(&msg->msg_iter, used); |
| } |
| |
| err = 0; |
| |
| unlock: |
| skcipher_wmem_wakeup(sk); |
| release_sock(sk); |
| |
| return copied ?: err; |
| } |
| |
| static int skcipher_recvmsg(struct socket *sock, struct msghdr *msg, |
| size_t ignored, int flags) |
| { |
| return (msg->msg_iocb && !is_sync_kiocb(msg->msg_iocb)) ? |
| skcipher_recvmsg_async(sock, msg, flags) : |
| skcipher_recvmsg_sync(sock, msg, flags); |
| } |
| |
| static unsigned int skcipher_poll(struct file *file, struct socket *sock, |
| poll_table *wait) |
| { |
| struct sock *sk = sock->sk; |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| unsigned int mask; |
| |
| sock_poll_wait(file, sk_sleep(sk), wait); |
| mask = 0; |
| |
| if (ctx->used) |
| mask |= POLLIN | POLLRDNORM; |
| |
| if (skcipher_writable(sk)) |
| mask |= POLLOUT | POLLWRNORM | POLLWRBAND; |
| |
| return mask; |
| } |
| |
| static struct proto_ops algif_skcipher_ops = { |
| .family = PF_ALG, |
| |
| .connect = sock_no_connect, |
| .socketpair = sock_no_socketpair, |
| .getname = sock_no_getname, |
| .ioctl = sock_no_ioctl, |
| .listen = sock_no_listen, |
| .shutdown = sock_no_shutdown, |
| .getsockopt = sock_no_getsockopt, |
| .mmap = sock_no_mmap, |
| .bind = sock_no_bind, |
| .accept = sock_no_accept, |
| .setsockopt = sock_no_setsockopt, |
| |
| .release = af_alg_release, |
| .sendmsg = skcipher_sendmsg, |
| .sendpage = skcipher_sendpage, |
| .recvmsg = skcipher_recvmsg, |
| .poll = skcipher_poll, |
| }; |
| |
| static int skcipher_check_key(struct socket *sock) |
| { |
| int err = 0; |
| struct sock *psk; |
| struct alg_sock *pask; |
| struct skcipher_tfm *tfm; |
| struct sock *sk = sock->sk; |
| struct alg_sock *ask = alg_sk(sk); |
| |
| lock_sock(sk); |
| if (ask->refcnt) |
| goto unlock_child; |
| |
| psk = ask->parent; |
| pask = alg_sk(ask->parent); |
| tfm = pask->private; |
| |
| err = -ENOKEY; |
| lock_sock_nested(psk, SINGLE_DEPTH_NESTING); |
| if (!tfm->has_key) |
| goto unlock; |
| |
| if (!pask->refcnt++) |
| sock_hold(psk); |
| |
| ask->refcnt = 1; |
| sock_put(psk); |
| |
| err = 0; |
| |
| unlock: |
| release_sock(psk); |
| unlock_child: |
| release_sock(sk); |
| |
| return err; |
| } |
| |
| static int skcipher_sendmsg_nokey(struct socket *sock, struct msghdr *msg, |
| size_t size) |
| { |
| int err; |
| |
| err = skcipher_check_key(sock); |
| if (err) |
| return err; |
| |
| return skcipher_sendmsg(sock, msg, size); |
| } |
| |
| static ssize_t skcipher_sendpage_nokey(struct socket *sock, struct page *page, |
| int offset, size_t size, int flags) |
| { |
| int err; |
| |
| err = skcipher_check_key(sock); |
| if (err) |
| return err; |
| |
| return skcipher_sendpage(sock, page, offset, size, flags); |
| } |
| |
| static int skcipher_recvmsg_nokey(struct socket *sock, struct msghdr *msg, |
| size_t ignored, int flags) |
| { |
| int err; |
| |
| err = skcipher_check_key(sock); |
| if (err) |
| return err; |
| |
| return skcipher_recvmsg(sock, msg, ignored, flags); |
| } |
| |
| static struct proto_ops algif_skcipher_ops_nokey = { |
| .family = PF_ALG, |
| |
| .connect = sock_no_connect, |
| .socketpair = sock_no_socketpair, |
| .getname = sock_no_getname, |
| .ioctl = sock_no_ioctl, |
| .listen = sock_no_listen, |
| .shutdown = sock_no_shutdown, |
| .getsockopt = sock_no_getsockopt, |
| .mmap = sock_no_mmap, |
| .bind = sock_no_bind, |
| .accept = sock_no_accept, |
| .setsockopt = sock_no_setsockopt, |
| |
| .release = af_alg_release, |
| .sendmsg = skcipher_sendmsg_nokey, |
| .sendpage = skcipher_sendpage_nokey, |
| .recvmsg = skcipher_recvmsg_nokey, |
| .poll = skcipher_poll, |
| }; |
| |
| static void *skcipher_bind(const char *name, u32 type, u32 mask) |
| { |
| struct skcipher_tfm *tfm; |
| struct crypto_skcipher *skcipher; |
| |
| tfm = kzalloc(sizeof(*tfm), GFP_KERNEL); |
| if (!tfm) |
| return ERR_PTR(-ENOMEM); |
| |
| skcipher = crypto_alloc_skcipher(name, type, mask); |
| if (IS_ERR(skcipher)) { |
| kfree(tfm); |
| return ERR_CAST(skcipher); |
| } |
| |
| tfm->skcipher = skcipher; |
| |
| return tfm; |
| } |
| |
| static void skcipher_release(void *private) |
| { |
| struct skcipher_tfm *tfm = private; |
| |
| crypto_free_skcipher(tfm->skcipher); |
| kfree(tfm); |
| } |
| |
| static int skcipher_setkey(void *private, const u8 *key, unsigned int keylen) |
| { |
| struct skcipher_tfm *tfm = private; |
| int err; |
| |
| err = crypto_skcipher_setkey(tfm->skcipher, key, keylen); |
| tfm->has_key = !err; |
| |
| return err; |
| } |
| |
| static void skcipher_wait(struct sock *sk) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| int ctr = 0; |
| |
| while (atomic_read(&ctx->inflight) && ctr++ < 100) |
| msleep(100); |
| } |
| |
| static void skcipher_sock_destruct(struct sock *sk) |
| { |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_ctx *ctx = ask->private; |
| struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(&ctx->req); |
| |
| if (atomic_read(&ctx->inflight)) |
| skcipher_wait(sk); |
| |
| skcipher_free_sgl(sk); |
| sock_kzfree_s(sk, ctx->iv, crypto_skcipher_ivsize(tfm)); |
| sock_kfree_s(sk, ctx, ctx->len); |
| af_alg_release_parent(sk); |
| } |
| |
| static int skcipher_accept_parent_nokey(void *private, struct sock *sk) |
| { |
| struct skcipher_ctx *ctx; |
| struct alg_sock *ask = alg_sk(sk); |
| struct skcipher_tfm *tfm = private; |
| struct crypto_skcipher *skcipher = tfm->skcipher; |
| unsigned int len = sizeof(*ctx) + crypto_skcipher_reqsize(skcipher); |
| |
| ctx = sock_kmalloc(sk, len, GFP_KERNEL); |
| if (!ctx) |
| return -ENOMEM; |
| |
| ctx->iv = sock_kmalloc(sk, crypto_skcipher_ivsize(skcipher), |
| GFP_KERNEL); |
| if (!ctx->iv) { |
| sock_kfree_s(sk, ctx, len); |
| return -ENOMEM; |
| } |
| |
| memset(ctx->iv, 0, crypto_skcipher_ivsize(skcipher)); |
| |
| INIT_LIST_HEAD(&ctx->tsgl); |
| ctx->len = len; |
| ctx->used = 0; |
| ctx->more = 0; |
| ctx->merge = 0; |
| ctx->enc = 0; |
| atomic_set(&ctx->inflight, 0); |
| af_alg_init_completion(&ctx->completion); |
| |
| ask->private = ctx; |
| |
| skcipher_request_set_tfm(&ctx->req, skcipher); |
| skcipher_request_set_callback(&ctx->req, CRYPTO_TFM_REQ_MAY_SLEEP | |
| CRYPTO_TFM_REQ_MAY_BACKLOG, |
| af_alg_complete, &ctx->completion); |
| |
| sk->sk_destruct = skcipher_sock_destruct; |
| |
| return 0; |
| } |
| |
| static int skcipher_accept_parent(void *private, struct sock *sk) |
| { |
| struct skcipher_tfm *tfm = private; |
| |
| if (!tfm->has_key && crypto_skcipher_has_setkey(tfm->skcipher)) |
| return -ENOKEY; |
| |
| return skcipher_accept_parent_nokey(private, sk); |
| } |
| |
| static const struct af_alg_type algif_type_skcipher = { |
| .bind = skcipher_bind, |
| .release = skcipher_release, |
| .setkey = skcipher_setkey, |
| .accept = skcipher_accept_parent, |
| .accept_nokey = skcipher_accept_parent_nokey, |
| .ops = &algif_skcipher_ops, |
| .ops_nokey = &algif_skcipher_ops_nokey, |
| .name = "skcipher", |
| .owner = THIS_MODULE |
| }; |
| |
| static int __init algif_skcipher_init(void) |
| { |
| return af_alg_register_type(&algif_type_skcipher); |
| } |
| |
| static void __exit algif_skcipher_exit(void) |
| { |
| int err = af_alg_unregister_type(&algif_type_skcipher); |
| BUG_ON(err); |
| } |
| |
| module_init(algif_skcipher_init); |
| module_exit(algif_skcipher_exit); |
| MODULE_LICENSE("GPL"); |