| /* | |
| * Copyright (c) 2016-2017, Mellanox Technologies. All rights reserved. | |
| * Copyright (c) 2016-2017, Dave Watson <davejwatson@fb.com>. All rights reserved. | |
| * | |
| * This software is available to you under a choice of one of two | |
| * licenses. You may choose to be licensed under the terms of the GNU | |
| * General Public License (GPL) Version 2, available from the file | |
| * COPYING in the main directory of this source tree, or the | |
| * OpenIB.org BSD license below: | |
| * | |
| * Redistribution and use in source and binary forms, with or | |
| * without modification, are permitted provided that the following | |
| * conditions are met: | |
| * | |
| * - Redistributions of source code must retain the above | |
| * copyright notice, this list of conditions and the following | |
| * disclaimer. | |
| * | |
| * - Redistributions in binary form must reproduce the above | |
| * copyright notice, this list of conditions and the following | |
| * disclaimer in the documentation and/or other materials | |
| * provided with the distribution. | |
| * | |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | |
| * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | |
| * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | |
| * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | |
| * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
| * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | |
| * SOFTWARE. | |
| */ | |
| #include <linux/module.h> | |
| #include <net/tcp.h> | |
| #include <net/inet_common.h> | |
| #include <linux/highmem.h> | |
| #include <linux/netdevice.h> | |
| #include <linux/sched/signal.h> | |
| #include <net/tls.h> | |
| MODULE_AUTHOR("Mellanox Technologies"); | |
| MODULE_DESCRIPTION("Transport Layer Security Support"); | |
| MODULE_LICENSE("Dual BSD/GPL"); | |
| static struct proto tls_base_prot; | |
| static struct proto tls_sw_prot; | |
| int wait_on_pending_writer(struct sock *sk, long *timeo) | |
| { | |
| int rc = 0; | |
| DEFINE_WAIT_FUNC(wait, woken_wake_function); | |
| add_wait_queue(sk_sleep(sk), &wait); | |
| while (1) { | |
| if (!*timeo) { | |
| rc = -EAGAIN; | |
| break; | |
| } | |
| if (signal_pending(current)) { | |
| rc = sock_intr_errno(*timeo); | |
| break; | |
| } | |
| if (sk_wait_event(sk, timeo, !sk->sk_write_pending, &wait)) | |
| break; | |
| } | |
| remove_wait_queue(sk_sleep(sk), &wait); | |
| return rc; | |
| } | |
| int tls_push_sg(struct sock *sk, | |
| struct tls_context *ctx, | |
| struct scatterlist *sg, | |
| u16 first_offset, | |
| int flags) | |
| { | |
| int sendpage_flags = flags | MSG_SENDPAGE_NOTLAST; | |
| int ret = 0; | |
| struct page *p; | |
| size_t size; | |
| int offset = first_offset; | |
| size = sg->length - offset; | |
| offset += sg->offset; | |
| while (1) { | |
| if (sg_is_last(sg)) | |
| sendpage_flags = flags; | |
| /* is sending application-limited? */ | |
| tcp_rate_check_app_limited(sk); | |
| p = sg_page(sg); | |
| retry: | |
| ret = do_tcp_sendpages(sk, p, offset, size, sendpage_flags); | |
| if (ret != size) { | |
| if (ret > 0) { | |
| offset += ret; | |
| size -= ret; | |
| goto retry; | |
| } | |
| offset -= sg->offset; | |
| ctx->partially_sent_offset = offset; | |
| ctx->partially_sent_record = (void *)sg; | |
| return ret; | |
| } | |
| put_page(p); | |
| sk_mem_uncharge(sk, sg->length); | |
| sg = sg_next(sg); | |
| if (!sg) | |
| break; | |
| offset = sg->offset; | |
| size = sg->length; | |
| } | |
| clear_bit(TLS_PENDING_CLOSED_RECORD, &ctx->flags); | |
| return 0; | |
| } | |
| static int tls_handle_open_record(struct sock *sk, int flags) | |
| { | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| if (tls_is_pending_open_record(ctx)) | |
| return ctx->push_pending_record(sk, flags); | |
| return 0; | |
| } | |
| int tls_proccess_cmsg(struct sock *sk, struct msghdr *msg, | |
| unsigned char *record_type) | |
| { | |
| struct cmsghdr *cmsg; | |
| int rc = -EINVAL; | |
| for_each_cmsghdr(cmsg, msg) { | |
| if (!CMSG_OK(msg, cmsg)) | |
| return -EINVAL; | |
| if (cmsg->cmsg_level != SOL_TLS) | |
| continue; | |
| switch (cmsg->cmsg_type) { | |
| case TLS_SET_RECORD_TYPE: | |
| if (cmsg->cmsg_len < CMSG_LEN(sizeof(*record_type))) | |
| return -EINVAL; | |
| if (msg->msg_flags & MSG_MORE) | |
| return -EINVAL; | |
| rc = tls_handle_open_record(sk, msg->msg_flags); | |
| if (rc) | |
| return rc; | |
| *record_type = *(unsigned char *)CMSG_DATA(cmsg); | |
| rc = 0; | |
| break; | |
| default: | |
| return -EINVAL; | |
| } | |
| } | |
| return rc; | |
| } | |
| int tls_push_pending_closed_record(struct sock *sk, struct tls_context *ctx, | |
| int flags, long *timeo) | |
| { | |
| struct scatterlist *sg; | |
| u16 offset; | |
| if (!tls_is_partially_sent_record(ctx)) | |
| return ctx->push_pending_record(sk, flags); | |
| sg = ctx->partially_sent_record; | |
| offset = ctx->partially_sent_offset; | |
| ctx->partially_sent_record = NULL; | |
| return tls_push_sg(sk, ctx, sg, offset, flags); | |
| } | |
| static void tls_write_space(struct sock *sk) | |
| { | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| if (!sk->sk_write_pending && tls_is_pending_closed_record(ctx)) { | |
| gfp_t sk_allocation = sk->sk_allocation; | |
| int rc; | |
| long timeo = 0; | |
| sk->sk_allocation = GFP_ATOMIC; | |
| rc = tls_push_pending_closed_record(sk, ctx, | |
| MSG_DONTWAIT | | |
| MSG_NOSIGNAL, | |
| &timeo); | |
| sk->sk_allocation = sk_allocation; | |
| if (rc < 0) | |
| return; | |
| } | |
| ctx->sk_write_space(sk); | |
| } | |
| static void tls_sk_proto_close(struct sock *sk, long timeout) | |
| { | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| long timeo = sock_sndtimeo(sk, 0); | |
| void (*sk_proto_close)(struct sock *sk, long timeout); | |
| lock_sock(sk); | |
| if (!tls_complete_pending_work(sk, ctx, 0, &timeo)) | |
| tls_handle_open_record(sk, 0); | |
| if (ctx->partially_sent_record) { | |
| struct scatterlist *sg = ctx->partially_sent_record; | |
| while (1) { | |
| put_page(sg_page(sg)); | |
| sk_mem_uncharge(sk, sg->length); | |
| if (sg_is_last(sg)) | |
| break; | |
| sg++; | |
| } | |
| } | |
| ctx->free_resources(sk); | |
| kfree(ctx->rec_seq); | |
| kfree(ctx->iv); | |
| sk_proto_close = ctx->sk_proto_close; | |
| kfree(ctx); | |
| release_sock(sk); | |
| sk_proto_close(sk, timeout); | |
| } | |
| static int do_tls_getsockopt_tx(struct sock *sk, char __user *optval, | |
| int __user *optlen) | |
| { | |
| int rc = 0; | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| struct tls_crypto_info *crypto_info; | |
| int len; | |
| if (get_user(len, optlen)) | |
| return -EFAULT; | |
| if (!optval || (len < sizeof(*crypto_info))) { | |
| rc = -EINVAL; | |
| goto out; | |
| } | |
| if (!ctx) { | |
| rc = -EBUSY; | |
| goto out; | |
| } | |
| /* get user crypto info */ | |
| crypto_info = &ctx->crypto_send; | |
| if (!TLS_CRYPTO_INFO_READY(crypto_info)) { | |
| rc = -EBUSY; | |
| goto out; | |
| } | |
| if (len == sizeof(*crypto_info)) { | |
| if (copy_to_user(optval, crypto_info, sizeof(*crypto_info))) | |
| rc = -EFAULT; | |
| goto out; | |
| } | |
| switch (crypto_info->cipher_type) { | |
| case TLS_CIPHER_AES_GCM_128: { | |
| struct tls12_crypto_info_aes_gcm_128 * | |
| crypto_info_aes_gcm_128 = | |
| container_of(crypto_info, | |
| struct tls12_crypto_info_aes_gcm_128, | |
| info); | |
| if (len != sizeof(*crypto_info_aes_gcm_128)) { | |
| rc = -EINVAL; | |
| goto out; | |
| } | |
| lock_sock(sk); | |
| memcpy(crypto_info_aes_gcm_128->iv, ctx->iv, | |
| TLS_CIPHER_AES_GCM_128_IV_SIZE); | |
| release_sock(sk); | |
| if (copy_to_user(optval, | |
| crypto_info_aes_gcm_128, | |
| sizeof(*crypto_info_aes_gcm_128))) | |
| rc = -EFAULT; | |
| break; | |
| } | |
| default: | |
| rc = -EINVAL; | |
| } | |
| out: | |
| return rc; | |
| } | |
| static int do_tls_getsockopt(struct sock *sk, int optname, | |
| char __user *optval, int __user *optlen) | |
| { | |
| int rc = 0; | |
| switch (optname) { | |
| case TLS_TX: | |
| rc = do_tls_getsockopt_tx(sk, optval, optlen); | |
| break; | |
| default: | |
| rc = -ENOPROTOOPT; | |
| break; | |
| } | |
| return rc; | |
| } | |
| static int tls_getsockopt(struct sock *sk, int level, int optname, | |
| char __user *optval, int __user *optlen) | |
| { | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| if (level != SOL_TLS) | |
| return ctx->getsockopt(sk, level, optname, optval, optlen); | |
| return do_tls_getsockopt(sk, optname, optval, optlen); | |
| } | |
| static int do_tls_setsockopt_tx(struct sock *sk, char __user *optval, | |
| unsigned int optlen) | |
| { | |
| struct tls_crypto_info *crypto_info, tmp_crypto_info; | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| struct proto *prot = NULL; | |
| int rc = 0; | |
| if (!optval || (optlen < sizeof(*crypto_info))) { | |
| rc = -EINVAL; | |
| goto out; | |
| } | |
| rc = copy_from_user(&tmp_crypto_info, optval, sizeof(*crypto_info)); | |
| if (rc) { | |
| rc = -EFAULT; | |
| goto out; | |
| } | |
| /* check version */ | |
| if (tmp_crypto_info.version != TLS_1_2_VERSION) { | |
| rc = -ENOTSUPP; | |
| goto out; | |
| } | |
| /* get user crypto info */ | |
| crypto_info = &ctx->crypto_send; | |
| /* Currently we don't support set crypto info more than one time */ | |
| if (TLS_CRYPTO_INFO_READY(crypto_info)) | |
| goto out; | |
| switch (tmp_crypto_info.cipher_type) { | |
| case TLS_CIPHER_AES_GCM_128: { | |
| if (optlen != sizeof(struct tls12_crypto_info_aes_gcm_128)) { | |
| rc = -EINVAL; | |
| goto out; | |
| } | |
| rc = copy_from_user( | |
| crypto_info, | |
| optval, | |
| sizeof(struct tls12_crypto_info_aes_gcm_128)); | |
| if (rc) { | |
| rc = -EFAULT; | |
| goto err_crypto_info; | |
| } | |
| break; | |
| } | |
| default: | |
| rc = -EINVAL; | |
| goto out; | |
| } | |
| ctx->sk_write_space = sk->sk_write_space; | |
| sk->sk_write_space = tls_write_space; | |
| ctx->sk_proto_close = sk->sk_prot->close; | |
| /* currently SW is default, we will have ethtool in future */ | |
| rc = tls_set_sw_offload(sk, ctx); | |
| prot = &tls_sw_prot; | |
| if (rc) | |
| goto err_crypto_info; | |
| sk->sk_prot = prot; | |
| goto out; | |
| err_crypto_info: | |
| memset(crypto_info, 0, sizeof(*crypto_info)); | |
| out: | |
| return rc; | |
| } | |
| static int do_tls_setsockopt(struct sock *sk, int optname, | |
| char __user *optval, unsigned int optlen) | |
| { | |
| int rc = 0; | |
| switch (optname) { | |
| case TLS_TX: | |
| lock_sock(sk); | |
| rc = do_tls_setsockopt_tx(sk, optval, optlen); | |
| release_sock(sk); | |
| break; | |
| default: | |
| rc = -ENOPROTOOPT; | |
| break; | |
| } | |
| return rc; | |
| } | |
| static int tls_setsockopt(struct sock *sk, int level, int optname, | |
| char __user *optval, unsigned int optlen) | |
| { | |
| struct tls_context *ctx = tls_get_ctx(sk); | |
| if (level != SOL_TLS) | |
| return ctx->setsockopt(sk, level, optname, optval, optlen); | |
| return do_tls_setsockopt(sk, optname, optval, optlen); | |
| } | |
| static int tls_init(struct sock *sk) | |
| { | |
| struct inet_connection_sock *icsk = inet_csk(sk); | |
| struct tls_context *ctx; | |
| int rc = 0; | |
| /* allocate tls context */ | |
| ctx = kzalloc(sizeof(*ctx), GFP_KERNEL); | |
| if (!ctx) { | |
| rc = -ENOMEM; | |
| goto out; | |
| } | |
| icsk->icsk_ulp_data = ctx; | |
| ctx->setsockopt = sk->sk_prot->setsockopt; | |
| ctx->getsockopt = sk->sk_prot->getsockopt; | |
| sk->sk_prot = &tls_base_prot; | |
| out: | |
| return rc; | |
| } | |
| static struct tcp_ulp_ops tcp_tls_ulp_ops __read_mostly = { | |
| .name = "tls", | |
| .owner = THIS_MODULE, | |
| .init = tls_init, | |
| }; | |
| static int __init tls_register(void) | |
| { | |
| tls_base_prot = tcp_prot; | |
| tls_base_prot.setsockopt = tls_setsockopt; | |
| tls_base_prot.getsockopt = tls_getsockopt; | |
| tls_sw_prot = tls_base_prot; | |
| tls_sw_prot.sendmsg = tls_sw_sendmsg; | |
| tls_sw_prot.sendpage = tls_sw_sendpage; | |
| tls_sw_prot.close = tls_sk_proto_close; | |
| tcp_register_ulp(&tcp_tls_ulp_ops); | |
| return 0; | |
| } | |
| static void __exit tls_unregister(void) | |
| { | |
| tcp_unregister_ulp(&tcp_tls_ulp_ops); | |
| } | |
| module_init(tls_register); | |
| module_exit(tls_unregister); |