18c2ecf20Sopenharmony_ci/* 28c2ecf20Sopenharmony_ci * Copyright (c) 2006, 2019 Oracle and/or its affiliates. All rights reserved. 38c2ecf20Sopenharmony_ci * 48c2ecf20Sopenharmony_ci * This software is available to you under a choice of one of two 58c2ecf20Sopenharmony_ci * licenses. You may choose to be licensed under the terms of the GNU 68c2ecf20Sopenharmony_ci * General Public License (GPL) Version 2, available from the file 78c2ecf20Sopenharmony_ci * COPYING in the main directory of this source tree, or the 88c2ecf20Sopenharmony_ci * OpenIB.org BSD license below: 98c2ecf20Sopenharmony_ci * 108c2ecf20Sopenharmony_ci * Redistribution and use in source and binary forms, with or 118c2ecf20Sopenharmony_ci * without modification, are permitted provided that the following 128c2ecf20Sopenharmony_ci * conditions are met: 138c2ecf20Sopenharmony_ci * 148c2ecf20Sopenharmony_ci * - Redistributions of source code must retain the above 158c2ecf20Sopenharmony_ci * copyright notice, this list of conditions and the following 168c2ecf20Sopenharmony_ci * disclaimer. 178c2ecf20Sopenharmony_ci * 188c2ecf20Sopenharmony_ci * - Redistributions in binary form must reproduce the above 198c2ecf20Sopenharmony_ci * copyright notice, this list of conditions and the following 208c2ecf20Sopenharmony_ci * disclaimer in the documentation and/or other materials 218c2ecf20Sopenharmony_ci * provided with the distribution. 228c2ecf20Sopenharmony_ci * 238c2ecf20Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 248c2ecf20Sopenharmony_ci * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 258c2ecf20Sopenharmony_ci * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 268c2ecf20Sopenharmony_ci * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 278c2ecf20Sopenharmony_ci * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 288c2ecf20Sopenharmony_ci * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 298c2ecf20Sopenharmony_ci * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 308c2ecf20Sopenharmony_ci * SOFTWARE. 318c2ecf20Sopenharmony_ci * 328c2ecf20Sopenharmony_ci */ 338c2ecf20Sopenharmony_ci#include <linux/module.h> 348c2ecf20Sopenharmony_ci#include <linux/errno.h> 358c2ecf20Sopenharmony_ci#include <linux/kernel.h> 368c2ecf20Sopenharmony_ci#include <linux/gfp.h> 378c2ecf20Sopenharmony_ci#include <linux/in.h> 388c2ecf20Sopenharmony_ci#include <linux/ipv6.h> 398c2ecf20Sopenharmony_ci#include <linux/poll.h> 408c2ecf20Sopenharmony_ci#include <net/sock.h> 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_ci#include "rds.h" 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ci/* this is just used for stats gathering :/ */ 458c2ecf20Sopenharmony_cistatic DEFINE_SPINLOCK(rds_sock_lock); 468c2ecf20Sopenharmony_cistatic unsigned long rds_sock_count; 478c2ecf20Sopenharmony_cistatic LIST_HEAD(rds_sock_list); 488c2ecf20Sopenharmony_ciDECLARE_WAIT_QUEUE_HEAD(rds_poll_waitq); 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_ci/* 518c2ecf20Sopenharmony_ci * This is called as the final descriptor referencing this socket is closed. 528c2ecf20Sopenharmony_ci * We have to unbind the socket so that another socket can be bound to the 538c2ecf20Sopenharmony_ci * address it was using. 548c2ecf20Sopenharmony_ci * 558c2ecf20Sopenharmony_ci * We have to be careful about racing with the incoming path. sock_orphan() 568c2ecf20Sopenharmony_ci * sets SOCK_DEAD and we use that as an indicator to the rx path that new 578c2ecf20Sopenharmony_ci * messages shouldn't be queued. 588c2ecf20Sopenharmony_ci */ 598c2ecf20Sopenharmony_cistatic int rds_release(struct socket *sock) 608c2ecf20Sopenharmony_ci{ 618c2ecf20Sopenharmony_ci struct sock *sk = sock->sk; 628c2ecf20Sopenharmony_ci struct rds_sock *rs; 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci if (!sk) 658c2ecf20Sopenharmony_ci goto out; 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_ci rs = rds_sk_to_rs(sk); 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_ci sock_orphan(sk); 708c2ecf20Sopenharmony_ci /* Note - rds_clear_recv_queue grabs rs_recv_lock, so 718c2ecf20Sopenharmony_ci * that ensures the recv path has completed messing 728c2ecf20Sopenharmony_ci * with the socket. */ 738c2ecf20Sopenharmony_ci rds_clear_recv_queue(rs); 748c2ecf20Sopenharmony_ci rds_cong_remove_socket(rs); 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci rds_remove_bound(rs); 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_ci rds_send_drop_to(rs, NULL); 798c2ecf20Sopenharmony_ci rds_rdma_drop_keys(rs); 808c2ecf20Sopenharmony_ci rds_notify_queue_get(rs, NULL); 818c2ecf20Sopenharmony_ci rds_notify_msg_zcopy_purge(&rs->rs_zcookie_queue); 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 848c2ecf20Sopenharmony_ci list_del_init(&rs->rs_item); 858c2ecf20Sopenharmony_ci rds_sock_count--; 868c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci rds_trans_put(rs->rs_transport); 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ci sock->sk = NULL; 918c2ecf20Sopenharmony_ci sock_put(sk); 928c2ecf20Sopenharmony_ciout: 938c2ecf20Sopenharmony_ci return 0; 948c2ecf20Sopenharmony_ci} 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci/* 978c2ecf20Sopenharmony_ci * Careful not to race with rds_release -> sock_orphan which clears sk_sleep. 988c2ecf20Sopenharmony_ci * _bh() isn't OK here, we're called from interrupt handlers. It's probably OK 998c2ecf20Sopenharmony_ci * to wake the waitqueue after sk_sleep is clear as we hold a sock ref, but 1008c2ecf20Sopenharmony_ci * this seems more conservative. 1018c2ecf20Sopenharmony_ci * NB - normally, one would use sk_callback_lock for this, but we can 1028c2ecf20Sopenharmony_ci * get here from interrupts, whereas the network code grabs sk_callback_lock 1038c2ecf20Sopenharmony_ci * with _lock_bh only - so relying on sk_callback_lock introduces livelocks. 1048c2ecf20Sopenharmony_ci */ 1058c2ecf20Sopenharmony_civoid rds_wake_sk_sleep(struct rds_sock *rs) 1068c2ecf20Sopenharmony_ci{ 1078c2ecf20Sopenharmony_ci unsigned long flags; 1088c2ecf20Sopenharmony_ci 1098c2ecf20Sopenharmony_ci read_lock_irqsave(&rs->rs_recv_lock, flags); 1108c2ecf20Sopenharmony_ci __rds_wake_sk_sleep(rds_rs_to_sk(rs)); 1118c2ecf20Sopenharmony_ci read_unlock_irqrestore(&rs->rs_recv_lock, flags); 1128c2ecf20Sopenharmony_ci} 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_cistatic int rds_getname(struct socket *sock, struct sockaddr *uaddr, 1158c2ecf20Sopenharmony_ci int peer) 1168c2ecf20Sopenharmony_ci{ 1178c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sock->sk); 1188c2ecf20Sopenharmony_ci struct sockaddr_in6 *sin6; 1198c2ecf20Sopenharmony_ci struct sockaddr_in *sin; 1208c2ecf20Sopenharmony_ci int uaddr_len; 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_ci /* racey, don't care */ 1238c2ecf20Sopenharmony_ci if (peer) { 1248c2ecf20Sopenharmony_ci if (ipv6_addr_any(&rs->rs_conn_addr)) 1258c2ecf20Sopenharmony_ci return -ENOTCONN; 1268c2ecf20Sopenharmony_ci 1278c2ecf20Sopenharmony_ci if (ipv6_addr_v4mapped(&rs->rs_conn_addr)) { 1288c2ecf20Sopenharmony_ci sin = (struct sockaddr_in *)uaddr; 1298c2ecf20Sopenharmony_ci memset(sin->sin_zero, 0, sizeof(sin->sin_zero)); 1308c2ecf20Sopenharmony_ci sin->sin_family = AF_INET; 1318c2ecf20Sopenharmony_ci sin->sin_port = rs->rs_conn_port; 1328c2ecf20Sopenharmony_ci sin->sin_addr.s_addr = rs->rs_conn_addr_v4; 1338c2ecf20Sopenharmony_ci uaddr_len = sizeof(*sin); 1348c2ecf20Sopenharmony_ci } else { 1358c2ecf20Sopenharmony_ci sin6 = (struct sockaddr_in6 *)uaddr; 1368c2ecf20Sopenharmony_ci sin6->sin6_family = AF_INET6; 1378c2ecf20Sopenharmony_ci sin6->sin6_port = rs->rs_conn_port; 1388c2ecf20Sopenharmony_ci sin6->sin6_addr = rs->rs_conn_addr; 1398c2ecf20Sopenharmony_ci sin6->sin6_flowinfo = 0; 1408c2ecf20Sopenharmony_ci /* scope_id is the same as in the bound address. */ 1418c2ecf20Sopenharmony_ci sin6->sin6_scope_id = rs->rs_bound_scope_id; 1428c2ecf20Sopenharmony_ci uaddr_len = sizeof(*sin6); 1438c2ecf20Sopenharmony_ci } 1448c2ecf20Sopenharmony_ci } else { 1458c2ecf20Sopenharmony_ci /* If socket is not yet bound and the socket is connected, 1468c2ecf20Sopenharmony_ci * set the return address family to be the same as the 1478c2ecf20Sopenharmony_ci * connected address, but with 0 address value. If it is not 1488c2ecf20Sopenharmony_ci * connected, set the family to be AF_UNSPEC (value 0) and 1498c2ecf20Sopenharmony_ci * the address size to be that of an IPv4 address. 1508c2ecf20Sopenharmony_ci */ 1518c2ecf20Sopenharmony_ci if (ipv6_addr_any(&rs->rs_bound_addr)) { 1528c2ecf20Sopenharmony_ci if (ipv6_addr_any(&rs->rs_conn_addr)) { 1538c2ecf20Sopenharmony_ci sin = (struct sockaddr_in *)uaddr; 1548c2ecf20Sopenharmony_ci memset(sin, 0, sizeof(*sin)); 1558c2ecf20Sopenharmony_ci sin->sin_family = AF_UNSPEC; 1568c2ecf20Sopenharmony_ci return sizeof(*sin); 1578c2ecf20Sopenharmony_ci } 1588c2ecf20Sopenharmony_ci 1598c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6) 1608c2ecf20Sopenharmony_ci if (!(ipv6_addr_type(&rs->rs_conn_addr) & 1618c2ecf20Sopenharmony_ci IPV6_ADDR_MAPPED)) { 1628c2ecf20Sopenharmony_ci sin6 = (struct sockaddr_in6 *)uaddr; 1638c2ecf20Sopenharmony_ci memset(sin6, 0, sizeof(*sin6)); 1648c2ecf20Sopenharmony_ci sin6->sin6_family = AF_INET6; 1658c2ecf20Sopenharmony_ci return sizeof(*sin6); 1668c2ecf20Sopenharmony_ci } 1678c2ecf20Sopenharmony_ci#endif 1688c2ecf20Sopenharmony_ci 1698c2ecf20Sopenharmony_ci sin = (struct sockaddr_in *)uaddr; 1708c2ecf20Sopenharmony_ci memset(sin, 0, sizeof(*sin)); 1718c2ecf20Sopenharmony_ci sin->sin_family = AF_INET; 1728c2ecf20Sopenharmony_ci return sizeof(*sin); 1738c2ecf20Sopenharmony_ci } 1748c2ecf20Sopenharmony_ci if (ipv6_addr_v4mapped(&rs->rs_bound_addr)) { 1758c2ecf20Sopenharmony_ci sin = (struct sockaddr_in *)uaddr; 1768c2ecf20Sopenharmony_ci memset(sin->sin_zero, 0, sizeof(sin->sin_zero)); 1778c2ecf20Sopenharmony_ci sin->sin_family = AF_INET; 1788c2ecf20Sopenharmony_ci sin->sin_port = rs->rs_bound_port; 1798c2ecf20Sopenharmony_ci sin->sin_addr.s_addr = rs->rs_bound_addr_v4; 1808c2ecf20Sopenharmony_ci uaddr_len = sizeof(*sin); 1818c2ecf20Sopenharmony_ci } else { 1828c2ecf20Sopenharmony_ci sin6 = (struct sockaddr_in6 *)uaddr; 1838c2ecf20Sopenharmony_ci sin6->sin6_family = AF_INET6; 1848c2ecf20Sopenharmony_ci sin6->sin6_port = rs->rs_bound_port; 1858c2ecf20Sopenharmony_ci sin6->sin6_addr = rs->rs_bound_addr; 1868c2ecf20Sopenharmony_ci sin6->sin6_flowinfo = 0; 1878c2ecf20Sopenharmony_ci sin6->sin6_scope_id = rs->rs_bound_scope_id; 1888c2ecf20Sopenharmony_ci uaddr_len = sizeof(*sin6); 1898c2ecf20Sopenharmony_ci } 1908c2ecf20Sopenharmony_ci } 1918c2ecf20Sopenharmony_ci 1928c2ecf20Sopenharmony_ci return uaddr_len; 1938c2ecf20Sopenharmony_ci} 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci/* 1968c2ecf20Sopenharmony_ci * RDS' poll is without a doubt the least intuitive part of the interface, 1978c2ecf20Sopenharmony_ci * as EPOLLIN and EPOLLOUT do not behave entirely as you would expect from 1988c2ecf20Sopenharmony_ci * a network protocol. 1998c2ecf20Sopenharmony_ci * 2008c2ecf20Sopenharmony_ci * EPOLLIN is asserted if 2018c2ecf20Sopenharmony_ci * - there is data on the receive queue. 2028c2ecf20Sopenharmony_ci * - to signal that a previously congested destination may have become 2038c2ecf20Sopenharmony_ci * uncongested 2048c2ecf20Sopenharmony_ci * - A notification has been queued to the socket (this can be a congestion 2058c2ecf20Sopenharmony_ci * update, or a RDMA completion, or a MSG_ZEROCOPY completion). 2068c2ecf20Sopenharmony_ci * 2078c2ecf20Sopenharmony_ci * EPOLLOUT is asserted if there is room on the send queue. This does not mean 2088c2ecf20Sopenharmony_ci * however, that the next sendmsg() call will succeed. If the application tries 2098c2ecf20Sopenharmony_ci * to send to a congested destination, the system call may still fail (and 2108c2ecf20Sopenharmony_ci * return ENOBUFS). 2118c2ecf20Sopenharmony_ci */ 2128c2ecf20Sopenharmony_cistatic __poll_t rds_poll(struct file *file, struct socket *sock, 2138c2ecf20Sopenharmony_ci poll_table *wait) 2148c2ecf20Sopenharmony_ci{ 2158c2ecf20Sopenharmony_ci struct sock *sk = sock->sk; 2168c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sk); 2178c2ecf20Sopenharmony_ci __poll_t mask = 0; 2188c2ecf20Sopenharmony_ci unsigned long flags; 2198c2ecf20Sopenharmony_ci 2208c2ecf20Sopenharmony_ci poll_wait(file, sk_sleep(sk), wait); 2218c2ecf20Sopenharmony_ci 2228c2ecf20Sopenharmony_ci if (rs->rs_seen_congestion) 2238c2ecf20Sopenharmony_ci poll_wait(file, &rds_poll_waitq, wait); 2248c2ecf20Sopenharmony_ci 2258c2ecf20Sopenharmony_ci read_lock_irqsave(&rs->rs_recv_lock, flags); 2268c2ecf20Sopenharmony_ci if (!rs->rs_cong_monitor) { 2278c2ecf20Sopenharmony_ci /* When a congestion map was updated, we signal EPOLLIN for 2288c2ecf20Sopenharmony_ci * "historical" reasons. Applications can also poll for 2298c2ecf20Sopenharmony_ci * WRBAND instead. */ 2308c2ecf20Sopenharmony_ci if (rds_cong_updated_since(&rs->rs_cong_track)) 2318c2ecf20Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM | EPOLLWRBAND); 2328c2ecf20Sopenharmony_ci } else { 2338c2ecf20Sopenharmony_ci spin_lock(&rs->rs_lock); 2348c2ecf20Sopenharmony_ci if (rs->rs_cong_notify) 2358c2ecf20Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM); 2368c2ecf20Sopenharmony_ci spin_unlock(&rs->rs_lock); 2378c2ecf20Sopenharmony_ci } 2388c2ecf20Sopenharmony_ci if (!list_empty(&rs->rs_recv_queue) || 2398c2ecf20Sopenharmony_ci !list_empty(&rs->rs_notify_queue) || 2408c2ecf20Sopenharmony_ci !list_empty(&rs->rs_zcookie_queue.zcookie_head)) 2418c2ecf20Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM); 2428c2ecf20Sopenharmony_ci if (rs->rs_snd_bytes < rds_sk_sndbuf(rs)) 2438c2ecf20Sopenharmony_ci mask |= (EPOLLOUT | EPOLLWRNORM); 2448c2ecf20Sopenharmony_ci if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue)) 2458c2ecf20Sopenharmony_ci mask |= POLLERR; 2468c2ecf20Sopenharmony_ci read_unlock_irqrestore(&rs->rs_recv_lock, flags); 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_ci /* clear state any time we wake a seen-congested socket */ 2498c2ecf20Sopenharmony_ci if (mask) 2508c2ecf20Sopenharmony_ci rs->rs_seen_congestion = 0; 2518c2ecf20Sopenharmony_ci 2528c2ecf20Sopenharmony_ci return mask; 2538c2ecf20Sopenharmony_ci} 2548c2ecf20Sopenharmony_ci 2558c2ecf20Sopenharmony_cistatic int rds_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 2568c2ecf20Sopenharmony_ci{ 2578c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sock->sk); 2588c2ecf20Sopenharmony_ci rds_tos_t utos, tos = 0; 2598c2ecf20Sopenharmony_ci 2608c2ecf20Sopenharmony_ci switch (cmd) { 2618c2ecf20Sopenharmony_ci case SIOCRDSSETTOS: 2628c2ecf20Sopenharmony_ci if (get_user(utos, (rds_tos_t __user *)arg)) 2638c2ecf20Sopenharmony_ci return -EFAULT; 2648c2ecf20Sopenharmony_ci 2658c2ecf20Sopenharmony_ci if (rs->rs_transport && 2668c2ecf20Sopenharmony_ci rs->rs_transport->get_tos_map) 2678c2ecf20Sopenharmony_ci tos = rs->rs_transport->get_tos_map(utos); 2688c2ecf20Sopenharmony_ci else 2698c2ecf20Sopenharmony_ci return -ENOIOCTLCMD; 2708c2ecf20Sopenharmony_ci 2718c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 2728c2ecf20Sopenharmony_ci if (rs->rs_tos || rs->rs_conn) { 2738c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 2748c2ecf20Sopenharmony_ci return -EINVAL; 2758c2ecf20Sopenharmony_ci } 2768c2ecf20Sopenharmony_ci rs->rs_tos = tos; 2778c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 2788c2ecf20Sopenharmony_ci break; 2798c2ecf20Sopenharmony_ci case SIOCRDSGETTOS: 2808c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 2818c2ecf20Sopenharmony_ci tos = rs->rs_tos; 2828c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 2838c2ecf20Sopenharmony_ci if (put_user(tos, (rds_tos_t __user *)arg)) 2848c2ecf20Sopenharmony_ci return -EFAULT; 2858c2ecf20Sopenharmony_ci break; 2868c2ecf20Sopenharmony_ci default: 2878c2ecf20Sopenharmony_ci return -ENOIOCTLCMD; 2888c2ecf20Sopenharmony_ci } 2898c2ecf20Sopenharmony_ci 2908c2ecf20Sopenharmony_ci return 0; 2918c2ecf20Sopenharmony_ci} 2928c2ecf20Sopenharmony_ci 2938c2ecf20Sopenharmony_cistatic int rds_cancel_sent_to(struct rds_sock *rs, sockptr_t optval, int len) 2948c2ecf20Sopenharmony_ci{ 2958c2ecf20Sopenharmony_ci struct sockaddr_in6 sin6; 2968c2ecf20Sopenharmony_ci struct sockaddr_in sin; 2978c2ecf20Sopenharmony_ci int ret = 0; 2988c2ecf20Sopenharmony_ci 2998c2ecf20Sopenharmony_ci /* racing with another thread binding seems ok here */ 3008c2ecf20Sopenharmony_ci if (ipv6_addr_any(&rs->rs_bound_addr)) { 3018c2ecf20Sopenharmony_ci ret = -ENOTCONN; /* XXX not a great errno */ 3028c2ecf20Sopenharmony_ci goto out; 3038c2ecf20Sopenharmony_ci } 3048c2ecf20Sopenharmony_ci 3058c2ecf20Sopenharmony_ci if (len < sizeof(struct sockaddr_in)) { 3068c2ecf20Sopenharmony_ci ret = -EINVAL; 3078c2ecf20Sopenharmony_ci goto out; 3088c2ecf20Sopenharmony_ci } else if (len < sizeof(struct sockaddr_in6)) { 3098c2ecf20Sopenharmony_ci /* Assume IPv4 */ 3108c2ecf20Sopenharmony_ci if (copy_from_sockptr(&sin, optval, 3118c2ecf20Sopenharmony_ci sizeof(struct sockaddr_in))) { 3128c2ecf20Sopenharmony_ci ret = -EFAULT; 3138c2ecf20Sopenharmony_ci goto out; 3148c2ecf20Sopenharmony_ci } 3158c2ecf20Sopenharmony_ci ipv6_addr_set_v4mapped(sin.sin_addr.s_addr, &sin6.sin6_addr); 3168c2ecf20Sopenharmony_ci sin6.sin6_port = sin.sin_port; 3178c2ecf20Sopenharmony_ci } else { 3188c2ecf20Sopenharmony_ci if (copy_from_sockptr(&sin6, optval, 3198c2ecf20Sopenharmony_ci sizeof(struct sockaddr_in6))) { 3208c2ecf20Sopenharmony_ci ret = -EFAULT; 3218c2ecf20Sopenharmony_ci goto out; 3228c2ecf20Sopenharmony_ci } 3238c2ecf20Sopenharmony_ci } 3248c2ecf20Sopenharmony_ci 3258c2ecf20Sopenharmony_ci rds_send_drop_to(rs, &sin6); 3268c2ecf20Sopenharmony_ciout: 3278c2ecf20Sopenharmony_ci return ret; 3288c2ecf20Sopenharmony_ci} 3298c2ecf20Sopenharmony_ci 3308c2ecf20Sopenharmony_cistatic int rds_set_bool_option(unsigned char *optvar, sockptr_t optval, 3318c2ecf20Sopenharmony_ci int optlen) 3328c2ecf20Sopenharmony_ci{ 3338c2ecf20Sopenharmony_ci int value; 3348c2ecf20Sopenharmony_ci 3358c2ecf20Sopenharmony_ci if (optlen < sizeof(int)) 3368c2ecf20Sopenharmony_ci return -EINVAL; 3378c2ecf20Sopenharmony_ci if (copy_from_sockptr(&value, optval, sizeof(int))) 3388c2ecf20Sopenharmony_ci return -EFAULT; 3398c2ecf20Sopenharmony_ci *optvar = !!value; 3408c2ecf20Sopenharmony_ci return 0; 3418c2ecf20Sopenharmony_ci} 3428c2ecf20Sopenharmony_ci 3438c2ecf20Sopenharmony_cistatic int rds_cong_monitor(struct rds_sock *rs, sockptr_t optval, int optlen) 3448c2ecf20Sopenharmony_ci{ 3458c2ecf20Sopenharmony_ci int ret; 3468c2ecf20Sopenharmony_ci 3478c2ecf20Sopenharmony_ci ret = rds_set_bool_option(&rs->rs_cong_monitor, optval, optlen); 3488c2ecf20Sopenharmony_ci if (ret == 0) { 3498c2ecf20Sopenharmony_ci if (rs->rs_cong_monitor) { 3508c2ecf20Sopenharmony_ci rds_cong_add_socket(rs); 3518c2ecf20Sopenharmony_ci } else { 3528c2ecf20Sopenharmony_ci rds_cong_remove_socket(rs); 3538c2ecf20Sopenharmony_ci rs->rs_cong_mask = 0; 3548c2ecf20Sopenharmony_ci rs->rs_cong_notify = 0; 3558c2ecf20Sopenharmony_ci } 3568c2ecf20Sopenharmony_ci } 3578c2ecf20Sopenharmony_ci return ret; 3588c2ecf20Sopenharmony_ci} 3598c2ecf20Sopenharmony_ci 3608c2ecf20Sopenharmony_cistatic int rds_set_transport(struct rds_sock *rs, sockptr_t optval, int optlen) 3618c2ecf20Sopenharmony_ci{ 3628c2ecf20Sopenharmony_ci int t_type; 3638c2ecf20Sopenharmony_ci 3648c2ecf20Sopenharmony_ci if (rs->rs_transport) 3658c2ecf20Sopenharmony_ci return -EOPNOTSUPP; /* previously attached to transport */ 3668c2ecf20Sopenharmony_ci 3678c2ecf20Sopenharmony_ci if (optlen != sizeof(int)) 3688c2ecf20Sopenharmony_ci return -EINVAL; 3698c2ecf20Sopenharmony_ci 3708c2ecf20Sopenharmony_ci if (copy_from_sockptr(&t_type, optval, sizeof(t_type))) 3718c2ecf20Sopenharmony_ci return -EFAULT; 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_ci if (t_type < 0 || t_type >= RDS_TRANS_COUNT) 3748c2ecf20Sopenharmony_ci return -EINVAL; 3758c2ecf20Sopenharmony_ci 3768c2ecf20Sopenharmony_ci rs->rs_transport = rds_trans_get(t_type); 3778c2ecf20Sopenharmony_ci 3788c2ecf20Sopenharmony_ci return rs->rs_transport ? 0 : -ENOPROTOOPT; 3798c2ecf20Sopenharmony_ci} 3808c2ecf20Sopenharmony_ci 3818c2ecf20Sopenharmony_cistatic int rds_enable_recvtstamp(struct sock *sk, sockptr_t optval, 3828c2ecf20Sopenharmony_ci int optlen, int optname) 3838c2ecf20Sopenharmony_ci{ 3848c2ecf20Sopenharmony_ci int val, valbool; 3858c2ecf20Sopenharmony_ci 3868c2ecf20Sopenharmony_ci if (optlen != sizeof(int)) 3878c2ecf20Sopenharmony_ci return -EFAULT; 3888c2ecf20Sopenharmony_ci 3898c2ecf20Sopenharmony_ci if (copy_from_sockptr(&val, optval, sizeof(int))) 3908c2ecf20Sopenharmony_ci return -EFAULT; 3918c2ecf20Sopenharmony_ci 3928c2ecf20Sopenharmony_ci valbool = val ? 1 : 0; 3938c2ecf20Sopenharmony_ci 3948c2ecf20Sopenharmony_ci if (optname == SO_TIMESTAMP_NEW) 3958c2ecf20Sopenharmony_ci sock_set_flag(sk, SOCK_TSTAMP_NEW); 3968c2ecf20Sopenharmony_ci 3978c2ecf20Sopenharmony_ci if (valbool) 3988c2ecf20Sopenharmony_ci sock_set_flag(sk, SOCK_RCVTSTAMP); 3998c2ecf20Sopenharmony_ci else 4008c2ecf20Sopenharmony_ci sock_reset_flag(sk, SOCK_RCVTSTAMP); 4018c2ecf20Sopenharmony_ci 4028c2ecf20Sopenharmony_ci return 0; 4038c2ecf20Sopenharmony_ci} 4048c2ecf20Sopenharmony_ci 4058c2ecf20Sopenharmony_cistatic int rds_recv_track_latency(struct rds_sock *rs, sockptr_t optval, 4068c2ecf20Sopenharmony_ci int optlen) 4078c2ecf20Sopenharmony_ci{ 4088c2ecf20Sopenharmony_ci struct rds_rx_trace_so trace; 4098c2ecf20Sopenharmony_ci int i; 4108c2ecf20Sopenharmony_ci 4118c2ecf20Sopenharmony_ci if (optlen != sizeof(struct rds_rx_trace_so)) 4128c2ecf20Sopenharmony_ci return -EFAULT; 4138c2ecf20Sopenharmony_ci 4148c2ecf20Sopenharmony_ci if (copy_from_sockptr(&trace, optval, sizeof(trace))) 4158c2ecf20Sopenharmony_ci return -EFAULT; 4168c2ecf20Sopenharmony_ci 4178c2ecf20Sopenharmony_ci if (trace.rx_traces > RDS_MSG_RX_DGRAM_TRACE_MAX) 4188c2ecf20Sopenharmony_ci return -EFAULT; 4198c2ecf20Sopenharmony_ci 4208c2ecf20Sopenharmony_ci rs->rs_rx_traces = trace.rx_traces; 4218c2ecf20Sopenharmony_ci for (i = 0; i < rs->rs_rx_traces; i++) { 4228c2ecf20Sopenharmony_ci if (trace.rx_trace_pos[i] >= RDS_MSG_RX_DGRAM_TRACE_MAX) { 4238c2ecf20Sopenharmony_ci rs->rs_rx_traces = 0; 4248c2ecf20Sopenharmony_ci return -EFAULT; 4258c2ecf20Sopenharmony_ci } 4268c2ecf20Sopenharmony_ci rs->rs_rx_trace[i] = trace.rx_trace_pos[i]; 4278c2ecf20Sopenharmony_ci } 4288c2ecf20Sopenharmony_ci 4298c2ecf20Sopenharmony_ci return 0; 4308c2ecf20Sopenharmony_ci} 4318c2ecf20Sopenharmony_ci 4328c2ecf20Sopenharmony_cistatic int rds_setsockopt(struct socket *sock, int level, int optname, 4338c2ecf20Sopenharmony_ci sockptr_t optval, unsigned int optlen) 4348c2ecf20Sopenharmony_ci{ 4358c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sock->sk); 4368c2ecf20Sopenharmony_ci int ret; 4378c2ecf20Sopenharmony_ci 4388c2ecf20Sopenharmony_ci if (level != SOL_RDS) { 4398c2ecf20Sopenharmony_ci ret = -ENOPROTOOPT; 4408c2ecf20Sopenharmony_ci goto out; 4418c2ecf20Sopenharmony_ci } 4428c2ecf20Sopenharmony_ci 4438c2ecf20Sopenharmony_ci switch (optname) { 4448c2ecf20Sopenharmony_ci case RDS_CANCEL_SENT_TO: 4458c2ecf20Sopenharmony_ci ret = rds_cancel_sent_to(rs, optval, optlen); 4468c2ecf20Sopenharmony_ci break; 4478c2ecf20Sopenharmony_ci case RDS_GET_MR: 4488c2ecf20Sopenharmony_ci ret = rds_get_mr(rs, optval, optlen); 4498c2ecf20Sopenharmony_ci break; 4508c2ecf20Sopenharmony_ci case RDS_GET_MR_FOR_DEST: 4518c2ecf20Sopenharmony_ci ret = rds_get_mr_for_dest(rs, optval, optlen); 4528c2ecf20Sopenharmony_ci break; 4538c2ecf20Sopenharmony_ci case RDS_FREE_MR: 4548c2ecf20Sopenharmony_ci ret = rds_free_mr(rs, optval, optlen); 4558c2ecf20Sopenharmony_ci break; 4568c2ecf20Sopenharmony_ci case RDS_RECVERR: 4578c2ecf20Sopenharmony_ci ret = rds_set_bool_option(&rs->rs_recverr, optval, optlen); 4588c2ecf20Sopenharmony_ci break; 4598c2ecf20Sopenharmony_ci case RDS_CONG_MONITOR: 4608c2ecf20Sopenharmony_ci ret = rds_cong_monitor(rs, optval, optlen); 4618c2ecf20Sopenharmony_ci break; 4628c2ecf20Sopenharmony_ci case SO_RDS_TRANSPORT: 4638c2ecf20Sopenharmony_ci lock_sock(sock->sk); 4648c2ecf20Sopenharmony_ci ret = rds_set_transport(rs, optval, optlen); 4658c2ecf20Sopenharmony_ci release_sock(sock->sk); 4668c2ecf20Sopenharmony_ci break; 4678c2ecf20Sopenharmony_ci case SO_TIMESTAMP_OLD: 4688c2ecf20Sopenharmony_ci case SO_TIMESTAMP_NEW: 4698c2ecf20Sopenharmony_ci lock_sock(sock->sk); 4708c2ecf20Sopenharmony_ci ret = rds_enable_recvtstamp(sock->sk, optval, optlen, optname); 4718c2ecf20Sopenharmony_ci release_sock(sock->sk); 4728c2ecf20Sopenharmony_ci break; 4738c2ecf20Sopenharmony_ci case SO_RDS_MSG_RXPATH_LATENCY: 4748c2ecf20Sopenharmony_ci ret = rds_recv_track_latency(rs, optval, optlen); 4758c2ecf20Sopenharmony_ci break; 4768c2ecf20Sopenharmony_ci default: 4778c2ecf20Sopenharmony_ci ret = -ENOPROTOOPT; 4788c2ecf20Sopenharmony_ci } 4798c2ecf20Sopenharmony_ciout: 4808c2ecf20Sopenharmony_ci return ret; 4818c2ecf20Sopenharmony_ci} 4828c2ecf20Sopenharmony_ci 4838c2ecf20Sopenharmony_cistatic int rds_getsockopt(struct socket *sock, int level, int optname, 4848c2ecf20Sopenharmony_ci char __user *optval, int __user *optlen) 4858c2ecf20Sopenharmony_ci{ 4868c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sock->sk); 4878c2ecf20Sopenharmony_ci int ret = -ENOPROTOOPT, len; 4888c2ecf20Sopenharmony_ci int trans; 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_ci if (level != SOL_RDS) 4918c2ecf20Sopenharmony_ci goto out; 4928c2ecf20Sopenharmony_ci 4938c2ecf20Sopenharmony_ci if (get_user(len, optlen)) { 4948c2ecf20Sopenharmony_ci ret = -EFAULT; 4958c2ecf20Sopenharmony_ci goto out; 4968c2ecf20Sopenharmony_ci } 4978c2ecf20Sopenharmony_ci 4988c2ecf20Sopenharmony_ci switch (optname) { 4998c2ecf20Sopenharmony_ci case RDS_INFO_FIRST ... RDS_INFO_LAST: 5008c2ecf20Sopenharmony_ci ret = rds_info_getsockopt(sock, optname, optval, 5018c2ecf20Sopenharmony_ci optlen); 5028c2ecf20Sopenharmony_ci break; 5038c2ecf20Sopenharmony_ci 5048c2ecf20Sopenharmony_ci case RDS_RECVERR: 5058c2ecf20Sopenharmony_ci if (len < sizeof(int)) 5068c2ecf20Sopenharmony_ci ret = -EINVAL; 5078c2ecf20Sopenharmony_ci else 5088c2ecf20Sopenharmony_ci if (put_user(rs->rs_recverr, (int __user *) optval) || 5098c2ecf20Sopenharmony_ci put_user(sizeof(int), optlen)) 5108c2ecf20Sopenharmony_ci ret = -EFAULT; 5118c2ecf20Sopenharmony_ci else 5128c2ecf20Sopenharmony_ci ret = 0; 5138c2ecf20Sopenharmony_ci break; 5148c2ecf20Sopenharmony_ci case SO_RDS_TRANSPORT: 5158c2ecf20Sopenharmony_ci if (len < sizeof(int)) { 5168c2ecf20Sopenharmony_ci ret = -EINVAL; 5178c2ecf20Sopenharmony_ci break; 5188c2ecf20Sopenharmony_ci } 5198c2ecf20Sopenharmony_ci trans = (rs->rs_transport ? rs->rs_transport->t_type : 5208c2ecf20Sopenharmony_ci RDS_TRANS_NONE); /* unbound */ 5218c2ecf20Sopenharmony_ci if (put_user(trans, (int __user *)optval) || 5228c2ecf20Sopenharmony_ci put_user(sizeof(int), optlen)) 5238c2ecf20Sopenharmony_ci ret = -EFAULT; 5248c2ecf20Sopenharmony_ci else 5258c2ecf20Sopenharmony_ci ret = 0; 5268c2ecf20Sopenharmony_ci break; 5278c2ecf20Sopenharmony_ci default: 5288c2ecf20Sopenharmony_ci break; 5298c2ecf20Sopenharmony_ci } 5308c2ecf20Sopenharmony_ci 5318c2ecf20Sopenharmony_ciout: 5328c2ecf20Sopenharmony_ci return ret; 5338c2ecf20Sopenharmony_ci 5348c2ecf20Sopenharmony_ci} 5358c2ecf20Sopenharmony_ci 5368c2ecf20Sopenharmony_cistatic int rds_connect(struct socket *sock, struct sockaddr *uaddr, 5378c2ecf20Sopenharmony_ci int addr_len, int flags) 5388c2ecf20Sopenharmony_ci{ 5398c2ecf20Sopenharmony_ci struct sock *sk = sock->sk; 5408c2ecf20Sopenharmony_ci struct sockaddr_in *sin; 5418c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sk); 5428c2ecf20Sopenharmony_ci int ret = 0; 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci if (addr_len < offsetofend(struct sockaddr, sa_family)) 5458c2ecf20Sopenharmony_ci return -EINVAL; 5468c2ecf20Sopenharmony_ci 5478c2ecf20Sopenharmony_ci lock_sock(sk); 5488c2ecf20Sopenharmony_ci 5498c2ecf20Sopenharmony_ci switch (uaddr->sa_family) { 5508c2ecf20Sopenharmony_ci case AF_INET: 5518c2ecf20Sopenharmony_ci sin = (struct sockaddr_in *)uaddr; 5528c2ecf20Sopenharmony_ci if (addr_len < sizeof(struct sockaddr_in)) { 5538c2ecf20Sopenharmony_ci ret = -EINVAL; 5548c2ecf20Sopenharmony_ci break; 5558c2ecf20Sopenharmony_ci } 5568c2ecf20Sopenharmony_ci if (sin->sin_addr.s_addr == htonl(INADDR_ANY)) { 5578c2ecf20Sopenharmony_ci ret = -EDESTADDRREQ; 5588c2ecf20Sopenharmony_ci break; 5598c2ecf20Sopenharmony_ci } 5608c2ecf20Sopenharmony_ci if (ipv4_is_multicast(sin->sin_addr.s_addr) || 5618c2ecf20Sopenharmony_ci sin->sin_addr.s_addr == htonl(INADDR_BROADCAST)) { 5628c2ecf20Sopenharmony_ci ret = -EINVAL; 5638c2ecf20Sopenharmony_ci break; 5648c2ecf20Sopenharmony_ci } 5658c2ecf20Sopenharmony_ci ipv6_addr_set_v4mapped(sin->sin_addr.s_addr, &rs->rs_conn_addr); 5668c2ecf20Sopenharmony_ci rs->rs_conn_port = sin->sin_port; 5678c2ecf20Sopenharmony_ci break; 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6) 5708c2ecf20Sopenharmony_ci case AF_INET6: { 5718c2ecf20Sopenharmony_ci struct sockaddr_in6 *sin6; 5728c2ecf20Sopenharmony_ci int addr_type; 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ci sin6 = (struct sockaddr_in6 *)uaddr; 5758c2ecf20Sopenharmony_ci if (addr_len < sizeof(struct sockaddr_in6)) { 5768c2ecf20Sopenharmony_ci ret = -EINVAL; 5778c2ecf20Sopenharmony_ci break; 5788c2ecf20Sopenharmony_ci } 5798c2ecf20Sopenharmony_ci addr_type = ipv6_addr_type(&sin6->sin6_addr); 5808c2ecf20Sopenharmony_ci if (!(addr_type & IPV6_ADDR_UNICAST)) { 5818c2ecf20Sopenharmony_ci __be32 addr4; 5828c2ecf20Sopenharmony_ci 5838c2ecf20Sopenharmony_ci if (!(addr_type & IPV6_ADDR_MAPPED)) { 5848c2ecf20Sopenharmony_ci ret = -EPROTOTYPE; 5858c2ecf20Sopenharmony_ci break; 5868c2ecf20Sopenharmony_ci } 5878c2ecf20Sopenharmony_ci 5888c2ecf20Sopenharmony_ci /* It is a mapped address. Need to do some sanity 5898c2ecf20Sopenharmony_ci * checks. 5908c2ecf20Sopenharmony_ci */ 5918c2ecf20Sopenharmony_ci addr4 = sin6->sin6_addr.s6_addr32[3]; 5928c2ecf20Sopenharmony_ci if (addr4 == htonl(INADDR_ANY) || 5938c2ecf20Sopenharmony_ci addr4 == htonl(INADDR_BROADCAST) || 5948c2ecf20Sopenharmony_ci ipv4_is_multicast(addr4)) { 5958c2ecf20Sopenharmony_ci ret = -EPROTOTYPE; 5968c2ecf20Sopenharmony_ci break; 5978c2ecf20Sopenharmony_ci } 5988c2ecf20Sopenharmony_ci } 5998c2ecf20Sopenharmony_ci 6008c2ecf20Sopenharmony_ci if (addr_type & IPV6_ADDR_LINKLOCAL) { 6018c2ecf20Sopenharmony_ci /* If socket is arleady bound to a link local address, 6028c2ecf20Sopenharmony_ci * the peer address must be on the same link. 6038c2ecf20Sopenharmony_ci */ 6048c2ecf20Sopenharmony_ci if (sin6->sin6_scope_id == 0 || 6058c2ecf20Sopenharmony_ci (!ipv6_addr_any(&rs->rs_bound_addr) && 6068c2ecf20Sopenharmony_ci rs->rs_bound_scope_id && 6078c2ecf20Sopenharmony_ci sin6->sin6_scope_id != rs->rs_bound_scope_id)) { 6088c2ecf20Sopenharmony_ci ret = -EINVAL; 6098c2ecf20Sopenharmony_ci break; 6108c2ecf20Sopenharmony_ci } 6118c2ecf20Sopenharmony_ci /* Remember the connected address scope ID. It will 6128c2ecf20Sopenharmony_ci * be checked against the binding local address when 6138c2ecf20Sopenharmony_ci * the socket is bound. 6148c2ecf20Sopenharmony_ci */ 6158c2ecf20Sopenharmony_ci rs->rs_bound_scope_id = sin6->sin6_scope_id; 6168c2ecf20Sopenharmony_ci } 6178c2ecf20Sopenharmony_ci rs->rs_conn_addr = sin6->sin6_addr; 6188c2ecf20Sopenharmony_ci rs->rs_conn_port = sin6->sin6_port; 6198c2ecf20Sopenharmony_ci break; 6208c2ecf20Sopenharmony_ci } 6218c2ecf20Sopenharmony_ci#endif 6228c2ecf20Sopenharmony_ci 6238c2ecf20Sopenharmony_ci default: 6248c2ecf20Sopenharmony_ci ret = -EAFNOSUPPORT; 6258c2ecf20Sopenharmony_ci break; 6268c2ecf20Sopenharmony_ci } 6278c2ecf20Sopenharmony_ci 6288c2ecf20Sopenharmony_ci release_sock(sk); 6298c2ecf20Sopenharmony_ci return ret; 6308c2ecf20Sopenharmony_ci} 6318c2ecf20Sopenharmony_ci 6328c2ecf20Sopenharmony_cistatic struct proto rds_proto = { 6338c2ecf20Sopenharmony_ci .name = "RDS", 6348c2ecf20Sopenharmony_ci .owner = THIS_MODULE, 6358c2ecf20Sopenharmony_ci .obj_size = sizeof(struct rds_sock), 6368c2ecf20Sopenharmony_ci}; 6378c2ecf20Sopenharmony_ci 6388c2ecf20Sopenharmony_cistatic const struct proto_ops rds_proto_ops = { 6398c2ecf20Sopenharmony_ci .family = AF_RDS, 6408c2ecf20Sopenharmony_ci .owner = THIS_MODULE, 6418c2ecf20Sopenharmony_ci .release = rds_release, 6428c2ecf20Sopenharmony_ci .bind = rds_bind, 6438c2ecf20Sopenharmony_ci .connect = rds_connect, 6448c2ecf20Sopenharmony_ci .socketpair = sock_no_socketpair, 6458c2ecf20Sopenharmony_ci .accept = sock_no_accept, 6468c2ecf20Sopenharmony_ci .getname = rds_getname, 6478c2ecf20Sopenharmony_ci .poll = rds_poll, 6488c2ecf20Sopenharmony_ci .ioctl = rds_ioctl, 6498c2ecf20Sopenharmony_ci .listen = sock_no_listen, 6508c2ecf20Sopenharmony_ci .shutdown = sock_no_shutdown, 6518c2ecf20Sopenharmony_ci .setsockopt = rds_setsockopt, 6528c2ecf20Sopenharmony_ci .getsockopt = rds_getsockopt, 6538c2ecf20Sopenharmony_ci .sendmsg = rds_sendmsg, 6548c2ecf20Sopenharmony_ci .recvmsg = rds_recvmsg, 6558c2ecf20Sopenharmony_ci .mmap = sock_no_mmap, 6568c2ecf20Sopenharmony_ci .sendpage = sock_no_sendpage, 6578c2ecf20Sopenharmony_ci}; 6588c2ecf20Sopenharmony_ci 6598c2ecf20Sopenharmony_cistatic void rds_sock_destruct(struct sock *sk) 6608c2ecf20Sopenharmony_ci{ 6618c2ecf20Sopenharmony_ci struct rds_sock *rs = rds_sk_to_rs(sk); 6628c2ecf20Sopenharmony_ci 6638c2ecf20Sopenharmony_ci WARN_ON((&rs->rs_item != rs->rs_item.next || 6648c2ecf20Sopenharmony_ci &rs->rs_item != rs->rs_item.prev)); 6658c2ecf20Sopenharmony_ci} 6668c2ecf20Sopenharmony_ci 6678c2ecf20Sopenharmony_cistatic int __rds_create(struct socket *sock, struct sock *sk, int protocol) 6688c2ecf20Sopenharmony_ci{ 6698c2ecf20Sopenharmony_ci struct rds_sock *rs; 6708c2ecf20Sopenharmony_ci 6718c2ecf20Sopenharmony_ci sock_init_data(sock, sk); 6728c2ecf20Sopenharmony_ci sock->ops = &rds_proto_ops; 6738c2ecf20Sopenharmony_ci sk->sk_protocol = protocol; 6748c2ecf20Sopenharmony_ci sk->sk_destruct = rds_sock_destruct; 6758c2ecf20Sopenharmony_ci 6768c2ecf20Sopenharmony_ci rs = rds_sk_to_rs(sk); 6778c2ecf20Sopenharmony_ci spin_lock_init(&rs->rs_lock); 6788c2ecf20Sopenharmony_ci rwlock_init(&rs->rs_recv_lock); 6798c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&rs->rs_send_queue); 6808c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&rs->rs_recv_queue); 6818c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&rs->rs_notify_queue); 6828c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&rs->rs_cong_list); 6838c2ecf20Sopenharmony_ci rds_message_zcopy_queue_init(&rs->rs_zcookie_queue); 6848c2ecf20Sopenharmony_ci spin_lock_init(&rs->rs_rdma_lock); 6858c2ecf20Sopenharmony_ci rs->rs_rdma_keys = RB_ROOT; 6868c2ecf20Sopenharmony_ci rs->rs_rx_traces = 0; 6878c2ecf20Sopenharmony_ci rs->rs_tos = 0; 6888c2ecf20Sopenharmony_ci rs->rs_conn = NULL; 6898c2ecf20Sopenharmony_ci 6908c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 6918c2ecf20Sopenharmony_ci list_add_tail(&rs->rs_item, &rds_sock_list); 6928c2ecf20Sopenharmony_ci rds_sock_count++; 6938c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 6948c2ecf20Sopenharmony_ci 6958c2ecf20Sopenharmony_ci return 0; 6968c2ecf20Sopenharmony_ci} 6978c2ecf20Sopenharmony_ci 6988c2ecf20Sopenharmony_cistatic int rds_create(struct net *net, struct socket *sock, int protocol, 6998c2ecf20Sopenharmony_ci int kern) 7008c2ecf20Sopenharmony_ci{ 7018c2ecf20Sopenharmony_ci struct sock *sk; 7028c2ecf20Sopenharmony_ci 7038c2ecf20Sopenharmony_ci if (sock->type != SOCK_SEQPACKET || protocol) 7048c2ecf20Sopenharmony_ci return -ESOCKTNOSUPPORT; 7058c2ecf20Sopenharmony_ci 7068c2ecf20Sopenharmony_ci sk = sk_alloc(net, AF_RDS, GFP_KERNEL, &rds_proto, kern); 7078c2ecf20Sopenharmony_ci if (!sk) 7088c2ecf20Sopenharmony_ci return -ENOMEM; 7098c2ecf20Sopenharmony_ci 7108c2ecf20Sopenharmony_ci return __rds_create(sock, sk, protocol); 7118c2ecf20Sopenharmony_ci} 7128c2ecf20Sopenharmony_ci 7138c2ecf20Sopenharmony_civoid rds_sock_addref(struct rds_sock *rs) 7148c2ecf20Sopenharmony_ci{ 7158c2ecf20Sopenharmony_ci sock_hold(rds_rs_to_sk(rs)); 7168c2ecf20Sopenharmony_ci} 7178c2ecf20Sopenharmony_ci 7188c2ecf20Sopenharmony_civoid rds_sock_put(struct rds_sock *rs) 7198c2ecf20Sopenharmony_ci{ 7208c2ecf20Sopenharmony_ci sock_put(rds_rs_to_sk(rs)); 7218c2ecf20Sopenharmony_ci} 7228c2ecf20Sopenharmony_ci 7238c2ecf20Sopenharmony_cistatic const struct net_proto_family rds_family_ops = { 7248c2ecf20Sopenharmony_ci .family = AF_RDS, 7258c2ecf20Sopenharmony_ci .create = rds_create, 7268c2ecf20Sopenharmony_ci .owner = THIS_MODULE, 7278c2ecf20Sopenharmony_ci}; 7288c2ecf20Sopenharmony_ci 7298c2ecf20Sopenharmony_cistatic void rds_sock_inc_info(struct socket *sock, unsigned int len, 7308c2ecf20Sopenharmony_ci struct rds_info_iterator *iter, 7318c2ecf20Sopenharmony_ci struct rds_info_lengths *lens) 7328c2ecf20Sopenharmony_ci{ 7338c2ecf20Sopenharmony_ci struct rds_sock *rs; 7348c2ecf20Sopenharmony_ci struct rds_incoming *inc; 7358c2ecf20Sopenharmony_ci unsigned int total = 0; 7368c2ecf20Sopenharmony_ci 7378c2ecf20Sopenharmony_ci len /= sizeof(struct rds_info_message); 7388c2ecf20Sopenharmony_ci 7398c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 7408c2ecf20Sopenharmony_ci 7418c2ecf20Sopenharmony_ci list_for_each_entry(rs, &rds_sock_list, rs_item) { 7428c2ecf20Sopenharmony_ci /* This option only supports IPv4 sockets. */ 7438c2ecf20Sopenharmony_ci if (!ipv6_addr_v4mapped(&rs->rs_bound_addr)) 7448c2ecf20Sopenharmony_ci continue; 7458c2ecf20Sopenharmony_ci 7468c2ecf20Sopenharmony_ci read_lock(&rs->rs_recv_lock); 7478c2ecf20Sopenharmony_ci 7488c2ecf20Sopenharmony_ci /* XXX too lazy to maintain counts.. */ 7498c2ecf20Sopenharmony_ci list_for_each_entry(inc, &rs->rs_recv_queue, i_item) { 7508c2ecf20Sopenharmony_ci total++; 7518c2ecf20Sopenharmony_ci if (total <= len) 7528c2ecf20Sopenharmony_ci rds_inc_info_copy(inc, iter, 7538c2ecf20Sopenharmony_ci inc->i_saddr.s6_addr32[3], 7548c2ecf20Sopenharmony_ci rs->rs_bound_addr_v4, 7558c2ecf20Sopenharmony_ci 1); 7568c2ecf20Sopenharmony_ci } 7578c2ecf20Sopenharmony_ci 7588c2ecf20Sopenharmony_ci read_unlock(&rs->rs_recv_lock); 7598c2ecf20Sopenharmony_ci } 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 7628c2ecf20Sopenharmony_ci 7638c2ecf20Sopenharmony_ci lens->nr = total; 7648c2ecf20Sopenharmony_ci lens->each = sizeof(struct rds_info_message); 7658c2ecf20Sopenharmony_ci} 7668c2ecf20Sopenharmony_ci 7678c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6) 7688c2ecf20Sopenharmony_cistatic void rds6_sock_inc_info(struct socket *sock, unsigned int len, 7698c2ecf20Sopenharmony_ci struct rds_info_iterator *iter, 7708c2ecf20Sopenharmony_ci struct rds_info_lengths *lens) 7718c2ecf20Sopenharmony_ci{ 7728c2ecf20Sopenharmony_ci struct rds_incoming *inc; 7738c2ecf20Sopenharmony_ci unsigned int total = 0; 7748c2ecf20Sopenharmony_ci struct rds_sock *rs; 7758c2ecf20Sopenharmony_ci 7768c2ecf20Sopenharmony_ci len /= sizeof(struct rds6_info_message); 7778c2ecf20Sopenharmony_ci 7788c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 7798c2ecf20Sopenharmony_ci 7808c2ecf20Sopenharmony_ci list_for_each_entry(rs, &rds_sock_list, rs_item) { 7818c2ecf20Sopenharmony_ci read_lock(&rs->rs_recv_lock); 7828c2ecf20Sopenharmony_ci 7838c2ecf20Sopenharmony_ci list_for_each_entry(inc, &rs->rs_recv_queue, i_item) { 7848c2ecf20Sopenharmony_ci total++; 7858c2ecf20Sopenharmony_ci if (total <= len) 7868c2ecf20Sopenharmony_ci rds6_inc_info_copy(inc, iter, &inc->i_saddr, 7878c2ecf20Sopenharmony_ci &rs->rs_bound_addr, 1); 7888c2ecf20Sopenharmony_ci } 7898c2ecf20Sopenharmony_ci 7908c2ecf20Sopenharmony_ci read_unlock(&rs->rs_recv_lock); 7918c2ecf20Sopenharmony_ci } 7928c2ecf20Sopenharmony_ci 7938c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 7948c2ecf20Sopenharmony_ci 7958c2ecf20Sopenharmony_ci lens->nr = total; 7968c2ecf20Sopenharmony_ci lens->each = sizeof(struct rds6_info_message); 7978c2ecf20Sopenharmony_ci} 7988c2ecf20Sopenharmony_ci#endif 7998c2ecf20Sopenharmony_ci 8008c2ecf20Sopenharmony_cistatic void rds_sock_info(struct socket *sock, unsigned int len, 8018c2ecf20Sopenharmony_ci struct rds_info_iterator *iter, 8028c2ecf20Sopenharmony_ci struct rds_info_lengths *lens) 8038c2ecf20Sopenharmony_ci{ 8048c2ecf20Sopenharmony_ci struct rds_info_socket sinfo; 8058c2ecf20Sopenharmony_ci unsigned int cnt = 0; 8068c2ecf20Sopenharmony_ci struct rds_sock *rs; 8078c2ecf20Sopenharmony_ci 8088c2ecf20Sopenharmony_ci len /= sizeof(struct rds_info_socket); 8098c2ecf20Sopenharmony_ci 8108c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 8118c2ecf20Sopenharmony_ci 8128c2ecf20Sopenharmony_ci if (len < rds_sock_count) { 8138c2ecf20Sopenharmony_ci cnt = rds_sock_count; 8148c2ecf20Sopenharmony_ci goto out; 8158c2ecf20Sopenharmony_ci } 8168c2ecf20Sopenharmony_ci 8178c2ecf20Sopenharmony_ci list_for_each_entry(rs, &rds_sock_list, rs_item) { 8188c2ecf20Sopenharmony_ci /* This option only supports IPv4 sockets. */ 8198c2ecf20Sopenharmony_ci if (!ipv6_addr_v4mapped(&rs->rs_bound_addr)) 8208c2ecf20Sopenharmony_ci continue; 8218c2ecf20Sopenharmony_ci sinfo.sndbuf = rds_sk_sndbuf(rs); 8228c2ecf20Sopenharmony_ci sinfo.rcvbuf = rds_sk_rcvbuf(rs); 8238c2ecf20Sopenharmony_ci sinfo.bound_addr = rs->rs_bound_addr_v4; 8248c2ecf20Sopenharmony_ci sinfo.connected_addr = rs->rs_conn_addr_v4; 8258c2ecf20Sopenharmony_ci sinfo.bound_port = rs->rs_bound_port; 8268c2ecf20Sopenharmony_ci sinfo.connected_port = rs->rs_conn_port; 8278c2ecf20Sopenharmony_ci sinfo.inum = sock_i_ino(rds_rs_to_sk(rs)); 8288c2ecf20Sopenharmony_ci 8298c2ecf20Sopenharmony_ci rds_info_copy(iter, &sinfo, sizeof(sinfo)); 8308c2ecf20Sopenharmony_ci cnt++; 8318c2ecf20Sopenharmony_ci } 8328c2ecf20Sopenharmony_ci 8338c2ecf20Sopenharmony_ciout: 8348c2ecf20Sopenharmony_ci lens->nr = cnt; 8358c2ecf20Sopenharmony_ci lens->each = sizeof(struct rds_info_socket); 8368c2ecf20Sopenharmony_ci 8378c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 8388c2ecf20Sopenharmony_ci} 8398c2ecf20Sopenharmony_ci 8408c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6) 8418c2ecf20Sopenharmony_cistatic void rds6_sock_info(struct socket *sock, unsigned int len, 8428c2ecf20Sopenharmony_ci struct rds_info_iterator *iter, 8438c2ecf20Sopenharmony_ci struct rds_info_lengths *lens) 8448c2ecf20Sopenharmony_ci{ 8458c2ecf20Sopenharmony_ci struct rds6_info_socket sinfo6; 8468c2ecf20Sopenharmony_ci struct rds_sock *rs; 8478c2ecf20Sopenharmony_ci 8488c2ecf20Sopenharmony_ci len /= sizeof(struct rds6_info_socket); 8498c2ecf20Sopenharmony_ci 8508c2ecf20Sopenharmony_ci spin_lock_bh(&rds_sock_lock); 8518c2ecf20Sopenharmony_ci 8528c2ecf20Sopenharmony_ci if (len < rds_sock_count) 8538c2ecf20Sopenharmony_ci goto out; 8548c2ecf20Sopenharmony_ci 8558c2ecf20Sopenharmony_ci list_for_each_entry(rs, &rds_sock_list, rs_item) { 8568c2ecf20Sopenharmony_ci sinfo6.sndbuf = rds_sk_sndbuf(rs); 8578c2ecf20Sopenharmony_ci sinfo6.rcvbuf = rds_sk_rcvbuf(rs); 8588c2ecf20Sopenharmony_ci sinfo6.bound_addr = rs->rs_bound_addr; 8598c2ecf20Sopenharmony_ci sinfo6.connected_addr = rs->rs_conn_addr; 8608c2ecf20Sopenharmony_ci sinfo6.bound_port = rs->rs_bound_port; 8618c2ecf20Sopenharmony_ci sinfo6.connected_port = rs->rs_conn_port; 8628c2ecf20Sopenharmony_ci sinfo6.inum = sock_i_ino(rds_rs_to_sk(rs)); 8638c2ecf20Sopenharmony_ci 8648c2ecf20Sopenharmony_ci rds_info_copy(iter, &sinfo6, sizeof(sinfo6)); 8658c2ecf20Sopenharmony_ci } 8668c2ecf20Sopenharmony_ci 8678c2ecf20Sopenharmony_ci out: 8688c2ecf20Sopenharmony_ci lens->nr = rds_sock_count; 8698c2ecf20Sopenharmony_ci lens->each = sizeof(struct rds6_info_socket); 8708c2ecf20Sopenharmony_ci 8718c2ecf20Sopenharmony_ci spin_unlock_bh(&rds_sock_lock); 8728c2ecf20Sopenharmony_ci} 8738c2ecf20Sopenharmony_ci#endif 8748c2ecf20Sopenharmony_ci 8758c2ecf20Sopenharmony_cistatic void rds_exit(void) 8768c2ecf20Sopenharmony_ci{ 8778c2ecf20Sopenharmony_ci sock_unregister(rds_family_ops.family); 8788c2ecf20Sopenharmony_ci proto_unregister(&rds_proto); 8798c2ecf20Sopenharmony_ci rds_conn_exit(); 8808c2ecf20Sopenharmony_ci rds_cong_exit(); 8818c2ecf20Sopenharmony_ci rds_sysctl_exit(); 8828c2ecf20Sopenharmony_ci rds_threads_exit(); 8838c2ecf20Sopenharmony_ci rds_stats_exit(); 8848c2ecf20Sopenharmony_ci rds_page_exit(); 8858c2ecf20Sopenharmony_ci rds_bind_lock_destroy(); 8868c2ecf20Sopenharmony_ci rds_info_deregister_func(RDS_INFO_SOCKETS, rds_sock_info); 8878c2ecf20Sopenharmony_ci rds_info_deregister_func(RDS_INFO_RECV_MESSAGES, rds_sock_inc_info); 8888c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6) 8898c2ecf20Sopenharmony_ci rds_info_deregister_func(RDS6_INFO_SOCKETS, rds6_sock_info); 8908c2ecf20Sopenharmony_ci rds_info_deregister_func(RDS6_INFO_RECV_MESSAGES, rds6_sock_inc_info); 8918c2ecf20Sopenharmony_ci#endif 8928c2ecf20Sopenharmony_ci} 8938c2ecf20Sopenharmony_cimodule_exit(rds_exit); 8948c2ecf20Sopenharmony_ci 8958c2ecf20Sopenharmony_ciu32 rds_gen_num; 8968c2ecf20Sopenharmony_ci 8978c2ecf20Sopenharmony_cistatic int rds_init(void) 8988c2ecf20Sopenharmony_ci{ 8998c2ecf20Sopenharmony_ci int ret; 9008c2ecf20Sopenharmony_ci 9018c2ecf20Sopenharmony_ci net_get_random_once(&rds_gen_num, sizeof(rds_gen_num)); 9028c2ecf20Sopenharmony_ci 9038c2ecf20Sopenharmony_ci ret = rds_bind_lock_init(); 9048c2ecf20Sopenharmony_ci if (ret) 9058c2ecf20Sopenharmony_ci goto out; 9068c2ecf20Sopenharmony_ci 9078c2ecf20Sopenharmony_ci ret = rds_conn_init(); 9088c2ecf20Sopenharmony_ci if (ret) 9098c2ecf20Sopenharmony_ci goto out_bind; 9108c2ecf20Sopenharmony_ci 9118c2ecf20Sopenharmony_ci ret = rds_threads_init(); 9128c2ecf20Sopenharmony_ci if (ret) 9138c2ecf20Sopenharmony_ci goto out_conn; 9148c2ecf20Sopenharmony_ci ret = rds_sysctl_init(); 9158c2ecf20Sopenharmony_ci if (ret) 9168c2ecf20Sopenharmony_ci goto out_threads; 9178c2ecf20Sopenharmony_ci ret = rds_stats_init(); 9188c2ecf20Sopenharmony_ci if (ret) 9198c2ecf20Sopenharmony_ci goto out_sysctl; 9208c2ecf20Sopenharmony_ci ret = proto_register(&rds_proto, 1); 9218c2ecf20Sopenharmony_ci if (ret) 9228c2ecf20Sopenharmony_ci goto out_stats; 9238c2ecf20Sopenharmony_ci ret = sock_register(&rds_family_ops); 9248c2ecf20Sopenharmony_ci if (ret) 9258c2ecf20Sopenharmony_ci goto out_proto; 9268c2ecf20Sopenharmony_ci 9278c2ecf20Sopenharmony_ci rds_info_register_func(RDS_INFO_SOCKETS, rds_sock_info); 9288c2ecf20Sopenharmony_ci rds_info_register_func(RDS_INFO_RECV_MESSAGES, rds_sock_inc_info); 9298c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6) 9308c2ecf20Sopenharmony_ci rds_info_register_func(RDS6_INFO_SOCKETS, rds6_sock_info); 9318c2ecf20Sopenharmony_ci rds_info_register_func(RDS6_INFO_RECV_MESSAGES, rds6_sock_inc_info); 9328c2ecf20Sopenharmony_ci#endif 9338c2ecf20Sopenharmony_ci 9348c2ecf20Sopenharmony_ci goto out; 9358c2ecf20Sopenharmony_ci 9368c2ecf20Sopenharmony_ciout_proto: 9378c2ecf20Sopenharmony_ci proto_unregister(&rds_proto); 9388c2ecf20Sopenharmony_ciout_stats: 9398c2ecf20Sopenharmony_ci rds_stats_exit(); 9408c2ecf20Sopenharmony_ciout_sysctl: 9418c2ecf20Sopenharmony_ci rds_sysctl_exit(); 9428c2ecf20Sopenharmony_ciout_threads: 9438c2ecf20Sopenharmony_ci rds_threads_exit(); 9448c2ecf20Sopenharmony_ciout_conn: 9458c2ecf20Sopenharmony_ci rds_conn_exit(); 9468c2ecf20Sopenharmony_ci rds_cong_exit(); 9478c2ecf20Sopenharmony_ci rds_page_exit(); 9488c2ecf20Sopenharmony_ciout_bind: 9498c2ecf20Sopenharmony_ci rds_bind_lock_destroy(); 9508c2ecf20Sopenharmony_ciout: 9518c2ecf20Sopenharmony_ci return ret; 9528c2ecf20Sopenharmony_ci} 9538c2ecf20Sopenharmony_cimodule_init(rds_init); 9548c2ecf20Sopenharmony_ci 9558c2ecf20Sopenharmony_ci#define DRV_VERSION "4.0" 9568c2ecf20Sopenharmony_ci#define DRV_RELDATE "Feb 12, 2009" 9578c2ecf20Sopenharmony_ci 9588c2ecf20Sopenharmony_ciMODULE_AUTHOR("Oracle Corporation <rds-devel@oss.oracle.com>"); 9598c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("RDS: Reliable Datagram Sockets" 9608c2ecf20Sopenharmony_ci " v" DRV_VERSION " (" DRV_RELDATE ")"); 9618c2ecf20Sopenharmony_ciMODULE_VERSION(DRV_VERSION); 9628c2ecf20Sopenharmony_ciMODULE_LICENSE("Dual BSD/GPL"); 9638c2ecf20Sopenharmony_ciMODULE_ALIAS_NETPROTO(PF_RDS); 964