xref: /openbmc/linux/net/rds/af_rds.c (revision 7d7ae873b5e0f46d19e5dc818d1a7809e4b7cc81)
1639b321bSAndy Grover /*
2a46b5b6cSKa-Cheong Poon  * Copyright (c) 2006, 2019 Oracle and/or its affiliates. All rights reserved.
3639b321bSAndy Grover  *
4639b321bSAndy Grover  * This software is available to you under a choice of one of two
5639b321bSAndy Grover  * licenses.  You may choose to be licensed under the terms of the GNU
6639b321bSAndy Grover  * General Public License (GPL) Version 2, available from the file
7639b321bSAndy Grover  * COPYING in the main directory of this source tree, or the
8639b321bSAndy Grover  * OpenIB.org BSD license below:
9639b321bSAndy Grover  *
10639b321bSAndy Grover  *     Redistribution and use in source and binary forms, with or
11639b321bSAndy Grover  *     without modification, are permitted provided that the following
12639b321bSAndy Grover  *     conditions are met:
13639b321bSAndy Grover  *
14639b321bSAndy Grover  *      - Redistributions of source code must retain the above
15639b321bSAndy Grover  *        copyright notice, this list of conditions and the following
16639b321bSAndy Grover  *        disclaimer.
17639b321bSAndy Grover  *
18639b321bSAndy Grover  *      - Redistributions in binary form must reproduce the above
19639b321bSAndy Grover  *        copyright notice, this list of conditions and the following
20639b321bSAndy Grover  *        disclaimer in the documentation and/or other materials
21639b321bSAndy Grover  *        provided with the distribution.
22639b321bSAndy Grover  *
23639b321bSAndy Grover  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24639b321bSAndy Grover  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25639b321bSAndy Grover  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26639b321bSAndy Grover  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27639b321bSAndy Grover  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28639b321bSAndy Grover  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29639b321bSAndy Grover  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30639b321bSAndy Grover  * SOFTWARE.
31639b321bSAndy Grover  *
32639b321bSAndy Grover  */
33639b321bSAndy Grover #include <linux/module.h>
34639b321bSAndy Grover #include <linux/errno.h>
35639b321bSAndy Grover #include <linux/kernel.h>
365a0e3ad6STejun Heo #include <linux/gfp.h>
37639b321bSAndy Grover #include <linux/in.h>
38eee2fa6aSKa-Cheong Poon #include <linux/ipv6.h>
39639b321bSAndy Grover #include <linux/poll.h>
40639b321bSAndy Grover #include <net/sock.h>
41639b321bSAndy Grover 
42639b321bSAndy Grover #include "rds.h"
43639b321bSAndy Grover 
44639b321bSAndy Grover /* this is just used for stats gathering :/ */
45639b321bSAndy Grover static DEFINE_SPINLOCK(rds_sock_lock);
46639b321bSAndy Grover static unsigned long rds_sock_count;
47639b321bSAndy Grover static LIST_HEAD(rds_sock_list);
48639b321bSAndy Grover DECLARE_WAIT_QUEUE_HEAD(rds_poll_waitq);
49639b321bSAndy Grover 
50639b321bSAndy Grover /*
51639b321bSAndy Grover  * This is called as the final descriptor referencing this socket is closed.
52639b321bSAndy Grover  * We have to unbind the socket so that another socket can be bound to the
53639b321bSAndy Grover  * address it was using.
54639b321bSAndy Grover  *
55639b321bSAndy Grover  * We have to be careful about racing with the incoming path.  sock_orphan()
56639b321bSAndy Grover  * sets SOCK_DEAD and we use that as an indicator to the rx path that new
57639b321bSAndy Grover  * messages shouldn't be queued.
58639b321bSAndy Grover  */
rds_release(struct socket * sock)59639b321bSAndy Grover static int rds_release(struct socket *sock)
60639b321bSAndy Grover {
61639b321bSAndy Grover 	struct sock *sk = sock->sk;
62639b321bSAndy Grover 	struct rds_sock *rs;
63639b321bSAndy Grover 
648690bfa1SAndy Grover 	if (!sk)
65639b321bSAndy Grover 		goto out;
66639b321bSAndy Grover 
67639b321bSAndy Grover 	rs = rds_sk_to_rs(sk);
68639b321bSAndy Grover 
69639b321bSAndy Grover 	sock_orphan(sk);
70639b321bSAndy Grover 	/* Note - rds_clear_recv_queue grabs rs_recv_lock, so
71639b321bSAndy Grover 	 * that ensures the recv path has completed messing
72639b321bSAndy Grover 	 * with the socket. */
73639b321bSAndy Grover 	rds_clear_recv_queue(rs);
74639b321bSAndy Grover 	rds_cong_remove_socket(rs);
7538a4e5e6SChris Mason 
76639b321bSAndy Grover 	rds_remove_bound(rs);
7738a4e5e6SChris Mason 
78639b321bSAndy Grover 	rds_send_drop_to(rs, NULL);
79639b321bSAndy Grover 	rds_rdma_drop_keys(rs);
80639b321bSAndy Grover 	rds_notify_queue_get(rs, NULL);
819426bbc6SSowmini Varadhan 	rds_notify_msg_zcopy_purge(&rs->rs_zcookie_queue);
82639b321bSAndy Grover 
83efc3dbc3SDavid S. Miller 	spin_lock_bh(&rds_sock_lock);
84639b321bSAndy Grover 	list_del_init(&rs->rs_item);
85639b321bSAndy Grover 	rds_sock_count--;
86efc3dbc3SDavid S. Miller 	spin_unlock_bh(&rds_sock_lock);
87639b321bSAndy Grover 
885adb5bc6SZach Brown 	rds_trans_put(rs->rs_transport);
895adb5bc6SZach Brown 
90639b321bSAndy Grover 	sock->sk = NULL;
91639b321bSAndy Grover 	sock_put(sk);
92639b321bSAndy Grover out:
93639b321bSAndy Grover 	return 0;
94639b321bSAndy Grover }
95639b321bSAndy Grover 
96639b321bSAndy Grover /*
97639b321bSAndy Grover  * Careful not to race with rds_release -> sock_orphan which clears sk_sleep.
98639b321bSAndy Grover  * _bh() isn't OK here, we're called from interrupt handlers.  It's probably OK
99639b321bSAndy Grover  * to wake the waitqueue after sk_sleep is clear as we hold a sock ref, but
100639b321bSAndy Grover  * this seems more conservative.
101639b321bSAndy Grover  * NB - normally, one would use sk_callback_lock for this, but we can
102639b321bSAndy Grover  * get here from interrupts, whereas the network code grabs sk_callback_lock
103639b321bSAndy Grover  * with _lock_bh only - so relying on sk_callback_lock introduces livelocks.
104639b321bSAndy Grover  */
rds_wake_sk_sleep(struct rds_sock * rs)105639b321bSAndy Grover void rds_wake_sk_sleep(struct rds_sock *rs)
106639b321bSAndy Grover {
107639b321bSAndy Grover 	unsigned long flags;
108639b321bSAndy Grover 
109639b321bSAndy Grover 	read_lock_irqsave(&rs->rs_recv_lock, flags);
110639b321bSAndy Grover 	__rds_wake_sk_sleep(rds_rs_to_sk(rs));
111639b321bSAndy Grover 	read_unlock_irqrestore(&rs->rs_recv_lock, flags);
112639b321bSAndy Grover }
113639b321bSAndy Grover 
rds_getname(struct socket * sock,struct sockaddr * uaddr,int peer)114639b321bSAndy Grover static int rds_getname(struct socket *sock, struct sockaddr *uaddr,
1159b2c45d4SDenys Vlasenko 		       int peer)
116639b321bSAndy Grover {
117639b321bSAndy Grover 	struct rds_sock *rs = rds_sk_to_rs(sock->sk);
118eee2fa6aSKa-Cheong Poon 	struct sockaddr_in6 *sin6;
119eee2fa6aSKa-Cheong Poon 	struct sockaddr_in *sin;
120eee2fa6aSKa-Cheong Poon 	int uaddr_len;
121639b321bSAndy Grover 
122639b321bSAndy Grover 	/* racey, don't care */
123639b321bSAndy Grover 	if (peer) {
124eee2fa6aSKa-Cheong Poon 		if (ipv6_addr_any(&rs->rs_conn_addr))
125639b321bSAndy Grover 			return -ENOTCONN;
126639b321bSAndy Grover 
127eee2fa6aSKa-Cheong Poon 		if (ipv6_addr_v4mapped(&rs->rs_conn_addr)) {
128eee2fa6aSKa-Cheong Poon 			sin = (struct sockaddr_in *)uaddr;
129eee2fa6aSKa-Cheong Poon 			memset(sin->sin_zero, 0, sizeof(sin->sin_zero));
130eee2fa6aSKa-Cheong Poon 			sin->sin_family = AF_INET;
131639b321bSAndy Grover 			sin->sin_port = rs->rs_conn_port;
132eee2fa6aSKa-Cheong Poon 			sin->sin_addr.s_addr = rs->rs_conn_addr_v4;
133eee2fa6aSKa-Cheong Poon 			uaddr_len = sizeof(*sin);
134639b321bSAndy Grover 		} else {
135eee2fa6aSKa-Cheong Poon 			sin6 = (struct sockaddr_in6 *)uaddr;
136eee2fa6aSKa-Cheong Poon 			sin6->sin6_family = AF_INET6;
137eee2fa6aSKa-Cheong Poon 			sin6->sin6_port = rs->rs_conn_port;
138eee2fa6aSKa-Cheong Poon 			sin6->sin6_addr = rs->rs_conn_addr;
139eee2fa6aSKa-Cheong Poon 			sin6->sin6_flowinfo = 0;
140eee2fa6aSKa-Cheong Poon 			/* scope_id is the same as in the bound address. */
141eee2fa6aSKa-Cheong Poon 			sin6->sin6_scope_id = rs->rs_bound_scope_id;
142eee2fa6aSKa-Cheong Poon 			uaddr_len = sizeof(*sin6);
143eee2fa6aSKa-Cheong Poon 		}
144eee2fa6aSKa-Cheong Poon 	} else {
1451e2b44e7SKa-Cheong Poon 		/* If socket is not yet bound and the socket is connected,
1461e2b44e7SKa-Cheong Poon 		 * set the return address family to be the same as the
1471e2b44e7SKa-Cheong Poon 		 * connected address, but with 0 address value.  If it is not
1481e2b44e7SKa-Cheong Poon 		 * connected, set the family to be AF_UNSPEC (value 0) and
1491e2b44e7SKa-Cheong Poon 		 * the address size to be that of an IPv4 address.
150eee2fa6aSKa-Cheong Poon 		 */
151eee2fa6aSKa-Cheong Poon 		if (ipv6_addr_any(&rs->rs_bound_addr)) {
1521e2b44e7SKa-Cheong Poon 			if (ipv6_addr_any(&rs->rs_conn_addr)) {
153eee2fa6aSKa-Cheong Poon 				sin = (struct sockaddr_in *)uaddr;
154eee2fa6aSKa-Cheong Poon 				memset(sin, 0, sizeof(*sin));
155eee2fa6aSKa-Cheong Poon 				sin->sin_family = AF_UNSPEC;
156eee2fa6aSKa-Cheong Poon 				return sizeof(*sin);
157eee2fa6aSKa-Cheong Poon 			}
1581e2b44e7SKa-Cheong Poon 
159e65d4d96SKa-Cheong Poon #if IS_ENABLED(CONFIG_IPV6)
160e65d4d96SKa-Cheong Poon 			if (!(ipv6_addr_type(&rs->rs_conn_addr) &
161e65d4d96SKa-Cheong Poon 			      IPV6_ADDR_MAPPED)) {
1621e2b44e7SKa-Cheong Poon 				sin6 = (struct sockaddr_in6 *)uaddr;
1631e2b44e7SKa-Cheong Poon 				memset(sin6, 0, sizeof(*sin6));
1641e2b44e7SKa-Cheong Poon 				sin6->sin6_family = AF_INET6;
1651e2b44e7SKa-Cheong Poon 				return sizeof(*sin6);
1661e2b44e7SKa-Cheong Poon 			}
167e65d4d96SKa-Cheong Poon #endif
168e65d4d96SKa-Cheong Poon 
169e65d4d96SKa-Cheong Poon 			sin = (struct sockaddr_in *)uaddr;
170e65d4d96SKa-Cheong Poon 			memset(sin, 0, sizeof(*sin));
171e65d4d96SKa-Cheong Poon 			sin->sin_family = AF_INET;
172e65d4d96SKa-Cheong Poon 			return sizeof(*sin);
173e65d4d96SKa-Cheong Poon 		}
174eee2fa6aSKa-Cheong Poon 		if (ipv6_addr_v4mapped(&rs->rs_bound_addr)) {
175eee2fa6aSKa-Cheong Poon 			sin = (struct sockaddr_in *)uaddr;
176eee2fa6aSKa-Cheong Poon 			memset(sin->sin_zero, 0, sizeof(sin->sin_zero));
177eee2fa6aSKa-Cheong Poon 			sin->sin_family = AF_INET;
178639b321bSAndy Grover 			sin->sin_port = rs->rs_bound_port;
179eee2fa6aSKa-Cheong Poon 			sin->sin_addr.s_addr = rs->rs_bound_addr_v4;
180eee2fa6aSKa-Cheong Poon 			uaddr_len = sizeof(*sin);
181eee2fa6aSKa-Cheong Poon 		} else {
182eee2fa6aSKa-Cheong Poon 			sin6 = (struct sockaddr_in6 *)uaddr;
183eee2fa6aSKa-Cheong Poon 			sin6->sin6_family = AF_INET6;
184eee2fa6aSKa-Cheong Poon 			sin6->sin6_port = rs->rs_bound_port;
185eee2fa6aSKa-Cheong Poon 			sin6->sin6_addr = rs->rs_bound_addr;
186eee2fa6aSKa-Cheong Poon 			sin6->sin6_flowinfo = 0;
187eee2fa6aSKa-Cheong Poon 			sin6->sin6_scope_id = rs->rs_bound_scope_id;
188eee2fa6aSKa-Cheong Poon 			uaddr_len = sizeof(*sin6);
189eee2fa6aSKa-Cheong Poon 		}
190639b321bSAndy Grover 	}
191639b321bSAndy Grover 
192eee2fa6aSKa-Cheong Poon 	return uaddr_len;
193639b321bSAndy Grover }
194639b321bSAndy Grover 
195639b321bSAndy Grover /*
196639b321bSAndy Grover  * RDS' poll is without a doubt the least intuitive part of the interface,
197a9a08845SLinus Torvalds  * as EPOLLIN and EPOLLOUT do not behave entirely as you would expect from
198639b321bSAndy Grover  * a network protocol.
199639b321bSAndy Grover  *
200a9a08845SLinus Torvalds  * EPOLLIN is asserted if
201639b321bSAndy Grover  *  -	there is data on the receive queue.
202639b321bSAndy Grover  *  -	to signal that a previously congested destination may have become
203639b321bSAndy Grover  *	uncongested
204639b321bSAndy Grover  *  -	A notification has been queued to the socket (this can be a congestion
205401910dbSSowmini Varadhan  *	update, or a RDMA completion, or a MSG_ZEROCOPY completion).
206639b321bSAndy Grover  *
207a9a08845SLinus Torvalds  * EPOLLOUT is asserted if there is room on the send queue. This does not mean
208639b321bSAndy Grover  * however, that the next sendmsg() call will succeed. If the application tries
209639b321bSAndy Grover  * to send to a congested destination, the system call may still fail (and
210639b321bSAndy Grover  * return ENOBUFS).
211639b321bSAndy Grover  */
rds_poll(struct file * file,struct socket * sock,poll_table * wait)212ade994f4SAl Viro static __poll_t rds_poll(struct file *file, struct socket *sock,
213639b321bSAndy Grover 			     poll_table *wait)
214639b321bSAndy Grover {
215639b321bSAndy Grover 	struct sock *sk = sock->sk;
216639b321bSAndy Grover 	struct rds_sock *rs = rds_sk_to_rs(sk);
217ade994f4SAl Viro 	__poll_t mask = 0;
218639b321bSAndy Grover 	unsigned long flags;
219639b321bSAndy Grover 
220aa395145SEric Dumazet 	poll_wait(file, sk_sleep(sk), wait);
221639b321bSAndy Grover 
222b98ba52fSAndy Grover 	if (rs->rs_seen_congestion)
223639b321bSAndy Grover 		poll_wait(file, &rds_poll_waitq, wait);
224639b321bSAndy Grover 
225639b321bSAndy Grover 	read_lock_irqsave(&rs->rs_recv_lock, flags);
226639b321bSAndy Grover 	if (!rs->rs_cong_monitor) {
227a9a08845SLinus Torvalds 		/* When a congestion map was updated, we signal EPOLLIN for
228639b321bSAndy Grover 		 * "historical" reasons. Applications can also poll for
229639b321bSAndy Grover 		 * WRBAND instead. */
230639b321bSAndy Grover 		if (rds_cong_updated_since(&rs->rs_cong_track))
231a9a08845SLinus Torvalds 			mask |= (EPOLLIN | EPOLLRDNORM | EPOLLWRBAND);
232639b321bSAndy Grover 	} else {
233639b321bSAndy Grover 		spin_lock(&rs->rs_lock);
234639b321bSAndy Grover 		if (rs->rs_cong_notify)
235a9a08845SLinus Torvalds 			mask |= (EPOLLIN | EPOLLRDNORM);
236639b321bSAndy Grover 		spin_unlock(&rs->rs_lock);
237639b321bSAndy Grover 	}
238f64f9e71SJoe Perches 	if (!list_empty(&rs->rs_recv_queue) ||
239401910dbSSowmini Varadhan 	    !list_empty(&rs->rs_notify_queue) ||
2409426bbc6SSowmini Varadhan 	    !list_empty(&rs->rs_zcookie_queue.zcookie_head))
241a9a08845SLinus Torvalds 		mask |= (EPOLLIN | EPOLLRDNORM);
242639b321bSAndy Grover 	if (rs->rs_snd_bytes < rds_sk_sndbuf(rs))
243a9a08845SLinus Torvalds 		mask |= (EPOLLOUT | EPOLLWRNORM);
24401883edaSSowmini Varadhan 	if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue))
24501883edaSSowmini Varadhan 		mask |= POLLERR;
246639b321bSAndy Grover 	read_unlock_irqrestore(&rs->rs_recv_lock, flags);
247639b321bSAndy Grover 
248b98ba52fSAndy Grover 	/* clear state any time we wake a seen-congested socket */
249b98ba52fSAndy Grover 	if (mask)
250b98ba52fSAndy Grover 		rs->rs_seen_congestion = 0;
251b98ba52fSAndy Grover 
252639b321bSAndy Grover 	return mask;
253639b321bSAndy Grover }
254639b321bSAndy Grover 
rds_ioctl(struct socket * sock,unsigned int cmd,unsigned long arg)255639b321bSAndy Grover static int rds_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
256639b321bSAndy Grover {
2573eb45036SSantosh Shilimkar 	struct rds_sock *rs = rds_sk_to_rs(sock->sk);
25856dc8bceSSantosh Shilimkar 	rds_tos_t utos, tos = 0;
2593eb45036SSantosh Shilimkar 
2603eb45036SSantosh Shilimkar 	switch (cmd) {
2613eb45036SSantosh Shilimkar 	case SIOCRDSSETTOS:
26256dc8bceSSantosh Shilimkar 		if (get_user(utos, (rds_tos_t __user *)arg))
2633eb45036SSantosh Shilimkar 			return -EFAULT;
2643eb45036SSantosh Shilimkar 
2653eb45036SSantosh Shilimkar 		if (rs->rs_transport &&
26656dc8bceSSantosh Shilimkar 		    rs->rs_transport->get_tos_map)
26756dc8bceSSantosh Shilimkar 			tos = rs->rs_transport->get_tos_map(utos);
26856dc8bceSSantosh Shilimkar 		else
26956dc8bceSSantosh Shilimkar 			return -ENOIOCTLCMD;
2703eb45036SSantosh Shilimkar 
2713eb45036SSantosh Shilimkar 		spin_lock_bh(&rds_sock_lock);
2723eb45036SSantosh Shilimkar 		if (rs->rs_tos || rs->rs_conn) {
2733eb45036SSantosh Shilimkar 			spin_unlock_bh(&rds_sock_lock);
2743eb45036SSantosh Shilimkar 			return -EINVAL;
2753eb45036SSantosh Shilimkar 		}
2763eb45036SSantosh Shilimkar 		rs->rs_tos = tos;
2773eb45036SSantosh Shilimkar 		spin_unlock_bh(&rds_sock_lock);
2783eb45036SSantosh Shilimkar 		break;
2793eb45036SSantosh Shilimkar 	case SIOCRDSGETTOS:
2803eb45036SSantosh Shilimkar 		spin_lock_bh(&rds_sock_lock);
2813eb45036SSantosh Shilimkar 		tos = rs->rs_tos;
2823eb45036SSantosh Shilimkar 		spin_unlock_bh(&rds_sock_lock);
2833eb45036SSantosh Shilimkar 		if (put_user(tos, (rds_tos_t __user *)arg))
2843eb45036SSantosh Shilimkar 			return -EFAULT;
2853eb45036SSantosh Shilimkar 		break;
2863eb45036SSantosh Shilimkar 	default:
287639b321bSAndy Grover 		return -ENOIOCTLCMD;
288639b321bSAndy Grover 	}
289639b321bSAndy Grover 
2903eb45036SSantosh Shilimkar 	return 0;
2913eb45036SSantosh Shilimkar }
2923eb45036SSantosh Shilimkar 
rds_cancel_sent_to(struct rds_sock * rs,sockptr_t optval,int len)293a7b75c5aSChristoph Hellwig static int rds_cancel_sent_to(struct rds_sock *rs, sockptr_t optval, int len)
294639b321bSAndy Grover {
295eee2fa6aSKa-Cheong Poon 	struct sockaddr_in6 sin6;
296639b321bSAndy Grover 	struct sockaddr_in sin;
297639b321bSAndy Grover 	int ret = 0;
298639b321bSAndy Grover 
299639b321bSAndy Grover 	/* racing with another thread binding seems ok here */
300eee2fa6aSKa-Cheong Poon 	if (ipv6_addr_any(&rs->rs_bound_addr)) {
301639b321bSAndy Grover 		ret = -ENOTCONN; /* XXX not a great errno */
302639b321bSAndy Grover 		goto out;
303639b321bSAndy Grover 	}
304639b321bSAndy Grover 
305639b321bSAndy Grover 	if (len < sizeof(struct sockaddr_in)) {
306639b321bSAndy Grover 		ret = -EINVAL;
307639b321bSAndy Grover 		goto out;
308eee2fa6aSKa-Cheong Poon 	} else if (len < sizeof(struct sockaddr_in6)) {
309eee2fa6aSKa-Cheong Poon 		/* Assume IPv4 */
310a7b75c5aSChristoph Hellwig 		if (copy_from_sockptr(&sin, optval,
311a7b75c5aSChristoph Hellwig 				sizeof(struct sockaddr_in))) {
312639b321bSAndy Grover 			ret = -EFAULT;
313639b321bSAndy Grover 			goto out;
314639b321bSAndy Grover 		}
315eee2fa6aSKa-Cheong Poon 		ipv6_addr_set_v4mapped(sin.sin_addr.s_addr, &sin6.sin6_addr);
316eee2fa6aSKa-Cheong Poon 		sin6.sin6_port = sin.sin_port;
317eee2fa6aSKa-Cheong Poon 	} else {
318a7b75c5aSChristoph Hellwig 		if (copy_from_sockptr(&sin6, optval,
319eee2fa6aSKa-Cheong Poon 				   sizeof(struct sockaddr_in6))) {
320eee2fa6aSKa-Cheong Poon 			ret = -EFAULT;
321eee2fa6aSKa-Cheong Poon 			goto out;
322eee2fa6aSKa-Cheong Poon 		}
323eee2fa6aSKa-Cheong Poon 	}
324639b321bSAndy Grover 
325eee2fa6aSKa-Cheong Poon 	rds_send_drop_to(rs, &sin6);
326639b321bSAndy Grover out:
327639b321bSAndy Grover 	return ret;
328639b321bSAndy Grover }
329639b321bSAndy Grover 
rds_set_bool_option(unsigned char * optvar,sockptr_t optval,int optlen)330a7b75c5aSChristoph Hellwig static int rds_set_bool_option(unsigned char *optvar, sockptr_t optval,
331639b321bSAndy Grover 			       int optlen)
332639b321bSAndy Grover {
333639b321bSAndy Grover 	int value;
334639b321bSAndy Grover 
335639b321bSAndy Grover 	if (optlen < sizeof(int))
336639b321bSAndy Grover 		return -EINVAL;
337a7b75c5aSChristoph Hellwig 	if (copy_from_sockptr(&value, optval, sizeof(int)))
338639b321bSAndy Grover 		return -EFAULT;
339639b321bSAndy Grover 	*optvar = !!value;
340639b321bSAndy Grover 	return 0;
341639b321bSAndy Grover }
342639b321bSAndy Grover 
rds_cong_monitor(struct rds_sock * rs,sockptr_t optval,int optlen)343a7b75c5aSChristoph Hellwig static int rds_cong_monitor(struct rds_sock *rs, sockptr_t optval, int optlen)
344639b321bSAndy Grover {
345639b321bSAndy Grover 	int ret;
346639b321bSAndy Grover 
347639b321bSAndy Grover 	ret = rds_set_bool_option(&rs->rs_cong_monitor, optval, optlen);
348639b321bSAndy Grover 	if (ret == 0) {
349639b321bSAndy Grover 		if (rs->rs_cong_monitor) {
350639b321bSAndy Grover 			rds_cong_add_socket(rs);
351639b321bSAndy Grover 		} else {
352639b321bSAndy Grover 			rds_cong_remove_socket(rs);
353639b321bSAndy Grover 			rs->rs_cong_mask = 0;
354639b321bSAndy Grover 			rs->rs_cong_notify = 0;
355639b321bSAndy Grover 		}
356639b321bSAndy Grover 	}
357639b321bSAndy Grover 	return ret;
358639b321bSAndy Grover }
359639b321bSAndy Grover 
rds_set_transport(struct rds_sock * rs,sockptr_t optval,int optlen)360a7b75c5aSChristoph Hellwig static int rds_set_transport(struct rds_sock *rs, sockptr_t optval, int optlen)
361d97dac54SSowmini Varadhan {
362d97dac54SSowmini Varadhan 	int t_type;
363d97dac54SSowmini Varadhan 
364d97dac54SSowmini Varadhan 	if (rs->rs_transport)
365d97dac54SSowmini Varadhan 		return -EOPNOTSUPP; /* previously attached to transport */
366d97dac54SSowmini Varadhan 
367d97dac54SSowmini Varadhan 	if (optlen != sizeof(int))
368d97dac54SSowmini Varadhan 		return -EINVAL;
369d97dac54SSowmini Varadhan 
370a7b75c5aSChristoph Hellwig 	if (copy_from_sockptr(&t_type, optval, sizeof(t_type)))
371d97dac54SSowmini Varadhan 		return -EFAULT;
372d97dac54SSowmini Varadhan 
373d97dac54SSowmini Varadhan 	if (t_type < 0 || t_type >= RDS_TRANS_COUNT)
374d97dac54SSowmini Varadhan 		return -EINVAL;
375d97dac54SSowmini Varadhan 
376d97dac54SSowmini Varadhan 	rs->rs_transport = rds_trans_get(t_type);
377d97dac54SSowmini Varadhan 
378d97dac54SSowmini Varadhan 	return rs->rs_transport ? 0 : -ENOPROTOOPT;
379d97dac54SSowmini Varadhan }
380d97dac54SSowmini Varadhan 
rds_enable_recvtstamp(struct sock * sk,sockptr_t optval,int optlen,int optname)381a7b75c5aSChristoph Hellwig static int rds_enable_recvtstamp(struct sock *sk, sockptr_t optval,
382887feae3SDeepa Dinamani 				 int optlen, int optname)
3835711f8b3Ssantosh.shilimkar@oracle.com {
3845711f8b3Ssantosh.shilimkar@oracle.com 	int val, valbool;
3855711f8b3Ssantosh.shilimkar@oracle.com 
3865711f8b3Ssantosh.shilimkar@oracle.com 	if (optlen != sizeof(int))
3875711f8b3Ssantosh.shilimkar@oracle.com 		return -EFAULT;
3885711f8b3Ssantosh.shilimkar@oracle.com 
389a7b75c5aSChristoph Hellwig 	if (copy_from_sockptr(&val, optval, sizeof(int)))
3905711f8b3Ssantosh.shilimkar@oracle.com 		return -EFAULT;
3915711f8b3Ssantosh.shilimkar@oracle.com 
3925711f8b3Ssantosh.shilimkar@oracle.com 	valbool = val ? 1 : 0;
3935711f8b3Ssantosh.shilimkar@oracle.com 
394887feae3SDeepa Dinamani 	if (optname == SO_TIMESTAMP_NEW)
395887feae3SDeepa Dinamani 		sock_set_flag(sk, SOCK_TSTAMP_NEW);
396887feae3SDeepa Dinamani 
3975711f8b3Ssantosh.shilimkar@oracle.com 	if (valbool)
3985711f8b3Ssantosh.shilimkar@oracle.com 		sock_set_flag(sk, SOCK_RCVTSTAMP);
3995711f8b3Ssantosh.shilimkar@oracle.com 	else
4005711f8b3Ssantosh.shilimkar@oracle.com 		sock_reset_flag(sk, SOCK_RCVTSTAMP);
4015711f8b3Ssantosh.shilimkar@oracle.com 
4025711f8b3Ssantosh.shilimkar@oracle.com 	return 0;
4035711f8b3Ssantosh.shilimkar@oracle.com }
4045711f8b3Ssantosh.shilimkar@oracle.com 
rds_recv_track_latency(struct rds_sock * rs,sockptr_t optval,int optlen)405a7b75c5aSChristoph Hellwig static int rds_recv_track_latency(struct rds_sock *rs, sockptr_t optval,
4063289025aSSantosh Shilimkar 				  int optlen)
4073289025aSSantosh Shilimkar {
4083289025aSSantosh Shilimkar 	struct rds_rx_trace_so trace;
4093289025aSSantosh Shilimkar 	int i;
4103289025aSSantosh Shilimkar 
4113289025aSSantosh Shilimkar 	if (optlen != sizeof(struct rds_rx_trace_so))
4123289025aSSantosh Shilimkar 		return -EFAULT;
4133289025aSSantosh Shilimkar 
414a7b75c5aSChristoph Hellwig 	if (copy_from_sockptr(&trace, optval, sizeof(trace)))
4153289025aSSantosh Shilimkar 		return -EFAULT;
4163289025aSSantosh Shilimkar 
417780e9829Ssantosh.shilimkar@oracle.com 	if (trace.rx_traces > RDS_MSG_RX_DGRAM_TRACE_MAX)
418780e9829Ssantosh.shilimkar@oracle.com 		return -EFAULT;
419780e9829Ssantosh.shilimkar@oracle.com 
4203289025aSSantosh Shilimkar 	rs->rs_rx_traces = trace.rx_traces;
4213289025aSSantosh Shilimkar 	for (i = 0; i < rs->rs_rx_traces; i++) {
422*7a73190eSSharath Srinivasan 		if (trace.rx_trace_pos[i] >= RDS_MSG_RX_DGRAM_TRACE_MAX) {
4233289025aSSantosh Shilimkar 			rs->rs_rx_traces = 0;
4243289025aSSantosh Shilimkar 			return -EFAULT;
4253289025aSSantosh Shilimkar 		}
4263289025aSSantosh Shilimkar 		rs->rs_rx_trace[i] = trace.rx_trace_pos[i];
4273289025aSSantosh Shilimkar 	}
4283289025aSSantosh Shilimkar 
4293289025aSSantosh Shilimkar 	return 0;
4303289025aSSantosh Shilimkar }
4313289025aSSantosh Shilimkar 
rds_setsockopt(struct socket * sock,int level,int optname,sockptr_t optval,unsigned int optlen)432639b321bSAndy Grover static int rds_setsockopt(struct socket *sock, int level, int optname,
433a7b75c5aSChristoph Hellwig 			  sockptr_t optval, unsigned int optlen)
434639b321bSAndy Grover {
435639b321bSAndy Grover 	struct rds_sock *rs = rds_sk_to_rs(sock->sk);
436639b321bSAndy Grover 	int ret;
437639b321bSAndy Grover 
438639b321bSAndy Grover 	if (level != SOL_RDS) {
439639b321bSAndy Grover 		ret = -ENOPROTOOPT;
440639b321bSAndy Grover 		goto out;
441639b321bSAndy Grover 	}
442639b321bSAndy Grover 
443639b321bSAndy Grover 	switch (optname) {
444639b321bSAndy Grover 	case RDS_CANCEL_SENT_TO:
445639b321bSAndy Grover 		ret = rds_cancel_sent_to(rs, optval, optlen);
446639b321bSAndy Grover 		break;
447639b321bSAndy Grover 	case RDS_GET_MR:
448639b321bSAndy Grover 		ret = rds_get_mr(rs, optval, optlen);
449639b321bSAndy Grover 		break;
450244546f0SAndy Grover 	case RDS_GET_MR_FOR_DEST:
451244546f0SAndy Grover 		ret = rds_get_mr_for_dest(rs, optval, optlen);
452244546f0SAndy Grover 		break;
453639b321bSAndy Grover 	case RDS_FREE_MR:
454639b321bSAndy Grover 		ret = rds_free_mr(rs, optval, optlen);
455639b321bSAndy Grover 		break;
456639b321bSAndy Grover 	case RDS_RECVERR:
457639b321bSAndy Grover 		ret = rds_set_bool_option(&rs->rs_recverr, optval, optlen);
458639b321bSAndy Grover 		break;
459639b321bSAndy Grover 	case RDS_CONG_MONITOR:
460639b321bSAndy Grover 		ret = rds_cong_monitor(rs, optval, optlen);
461639b321bSAndy Grover 		break;
462d97dac54SSowmini Varadhan 	case SO_RDS_TRANSPORT:
463d97dac54SSowmini Varadhan 		lock_sock(sock->sk);
464d97dac54SSowmini Varadhan 		ret = rds_set_transport(rs, optval, optlen);
465d97dac54SSowmini Varadhan 		release_sock(sock->sk);
466d97dac54SSowmini Varadhan 		break;
4677f1bc6e9SDeepa Dinamani 	case SO_TIMESTAMP_OLD:
468887feae3SDeepa Dinamani 	case SO_TIMESTAMP_NEW:
4695711f8b3Ssantosh.shilimkar@oracle.com 		lock_sock(sock->sk);
470887feae3SDeepa Dinamani 		ret = rds_enable_recvtstamp(sock->sk, optval, optlen, optname);
4715711f8b3Ssantosh.shilimkar@oracle.com 		release_sock(sock->sk);
4725711f8b3Ssantosh.shilimkar@oracle.com 		break;
4733289025aSSantosh Shilimkar 	case SO_RDS_MSG_RXPATH_LATENCY:
4743289025aSSantosh Shilimkar 		ret = rds_recv_track_latency(rs, optval, optlen);
4753289025aSSantosh Shilimkar 		break;
476639b321bSAndy Grover 	default:
477639b321bSAndy Grover 		ret = -ENOPROTOOPT;
478639b321bSAndy Grover 	}
479639b321bSAndy Grover out:
480639b321bSAndy Grover 	return ret;
481639b321bSAndy Grover }
482639b321bSAndy Grover 
rds_getsockopt(struct socket * sock,int level,int optname,char __user * optval,int __user * optlen)483639b321bSAndy Grover static int rds_getsockopt(struct socket *sock, int level, int optname,
484639b321bSAndy Grover 			  char __user *optval, int __user *optlen)
485639b321bSAndy Grover {
486639b321bSAndy Grover 	struct rds_sock *rs = rds_sk_to_rs(sock->sk);
487639b321bSAndy Grover 	int ret = -ENOPROTOOPT, len;
4888ba38460SSowmini Varadhan 	int trans;
489639b321bSAndy Grover 
490639b321bSAndy Grover 	if (level != SOL_RDS)
491639b321bSAndy Grover 		goto out;
492639b321bSAndy Grover 
493639b321bSAndy Grover 	if (get_user(len, optlen)) {
494639b321bSAndy Grover 		ret = -EFAULT;
495639b321bSAndy Grover 		goto out;
496639b321bSAndy Grover 	}
497639b321bSAndy Grover 
498639b321bSAndy Grover 	switch (optname) {
499639b321bSAndy Grover 	case RDS_INFO_FIRST ... RDS_INFO_LAST:
500639b321bSAndy Grover 		ret = rds_info_getsockopt(sock, optname, optval,
501639b321bSAndy Grover 					  optlen);
502639b321bSAndy Grover 		break;
503639b321bSAndy Grover 
504639b321bSAndy Grover 	case RDS_RECVERR:
505639b321bSAndy Grover 		if (len < sizeof(int))
506639b321bSAndy Grover 			ret = -EINVAL;
507639b321bSAndy Grover 		else
508f64f9e71SJoe Perches 		if (put_user(rs->rs_recverr, (int __user *) optval) ||
509f64f9e71SJoe Perches 		    put_user(sizeof(int), optlen))
510639b321bSAndy Grover 			ret = -EFAULT;
511639b321bSAndy Grover 		else
512639b321bSAndy Grover 			ret = 0;
513639b321bSAndy Grover 		break;
5148ba38460SSowmini Varadhan 	case SO_RDS_TRANSPORT:
5158ba38460SSowmini Varadhan 		if (len < sizeof(int)) {
5168ba38460SSowmini Varadhan 			ret = -EINVAL;
5178ba38460SSowmini Varadhan 			break;
5188ba38460SSowmini Varadhan 		}
5198ba38460SSowmini Varadhan 		trans = (rs->rs_transport ? rs->rs_transport->t_type :
5208ba38460SSowmini Varadhan 			 RDS_TRANS_NONE); /* unbound */
5218ba38460SSowmini Varadhan 		if (put_user(trans, (int __user *)optval) ||
5228ba38460SSowmini Varadhan 		    put_user(sizeof(int), optlen))
5238ba38460SSowmini Varadhan 			ret = -EFAULT;
5248ba38460SSowmini Varadhan 		else
5258ba38460SSowmini Varadhan 			ret = 0;
5268ba38460SSowmini Varadhan 		break;
527639b321bSAndy Grover 	default:
528639b321bSAndy Grover 		break;
529639b321bSAndy Grover 	}
530639b321bSAndy Grover 
531639b321bSAndy Grover out:
532639b321bSAndy Grover 	return ret;
533639b321bSAndy Grover 
534639b321bSAndy Grover }
535639b321bSAndy Grover 
rds_connect(struct socket * sock,struct sockaddr * uaddr,int addr_len,int flags)536639b321bSAndy Grover static int rds_connect(struct socket *sock, struct sockaddr *uaddr,
537639b321bSAndy Grover 		       int addr_len, int flags)
538639b321bSAndy Grover {
539639b321bSAndy Grover 	struct sock *sk = sock->sk;
540eee2fa6aSKa-Cheong Poon 	struct sockaddr_in *sin;
541639b321bSAndy Grover 	struct rds_sock *rs = rds_sk_to_rs(sk);
542639b321bSAndy Grover 	int ret = 0;
543639b321bSAndy Grover 
544dd3ac9a6STetsuo Handa 	if (addr_len < offsetofend(struct sockaddr, sa_family))
545dd3ac9a6STetsuo Handa 		return -EINVAL;
546dd3ac9a6STetsuo Handa 
547639b321bSAndy Grover 	lock_sock(sk);
548639b321bSAndy Grover 
5491e2b44e7SKa-Cheong Poon 	switch (uaddr->sa_family) {
5501e2b44e7SKa-Cheong Poon 	case AF_INET:
551eee2fa6aSKa-Cheong Poon 		sin = (struct sockaddr_in *)uaddr;
5521e2b44e7SKa-Cheong Poon 		if (addr_len < sizeof(struct sockaddr_in)) {
5531e2b44e7SKa-Cheong Poon 			ret = -EINVAL;
554eee2fa6aSKa-Cheong Poon 			break;
555639b321bSAndy Grover 		}
556639b321bSAndy Grover 		if (sin->sin_addr.s_addr == htonl(INADDR_ANY)) {
557639b321bSAndy Grover 			ret = -EDESTADDRREQ;
558eee2fa6aSKa-Cheong Poon 			break;
559eee2fa6aSKa-Cheong Poon 		}
560842841ecSDave Taht 		if (ipv4_is_multicast(sin->sin_addr.s_addr) ||
561eee2fa6aSKa-Cheong Poon 		    sin->sin_addr.s_addr == htonl(INADDR_BROADCAST)) {
562eee2fa6aSKa-Cheong Poon 			ret = -EINVAL;
563eee2fa6aSKa-Cheong Poon 			break;
564eee2fa6aSKa-Cheong Poon 		}
565eee2fa6aSKa-Cheong Poon 		ipv6_addr_set_v4mapped(sin->sin_addr.s_addr, &rs->rs_conn_addr);
566eee2fa6aSKa-Cheong Poon 		rs->rs_conn_port = sin->sin_port;
567eee2fa6aSKa-Cheong Poon 		break;
568eee2fa6aSKa-Cheong Poon 
569e65d4d96SKa-Cheong Poon #if IS_ENABLED(CONFIG_IPV6)
570e65d4d96SKa-Cheong Poon 	case AF_INET6: {
571e65d4d96SKa-Cheong Poon 		struct sockaddr_in6 *sin6;
572e65d4d96SKa-Cheong Poon 		int addr_type;
573e65d4d96SKa-Cheong Poon 
5741e2b44e7SKa-Cheong Poon 		sin6 = (struct sockaddr_in6 *)uaddr;
5751e2b44e7SKa-Cheong Poon 		if (addr_len < sizeof(struct sockaddr_in6)) {
5761e2b44e7SKa-Cheong Poon 			ret = -EINVAL;
5771e2b44e7SKa-Cheong Poon 			break;
5781e2b44e7SKa-Cheong Poon 		}
5791e2b44e7SKa-Cheong Poon 		addr_type = ipv6_addr_type(&sin6->sin6_addr);
5801e2b44e7SKa-Cheong Poon 		if (!(addr_type & IPV6_ADDR_UNICAST)) {
5811e2b44e7SKa-Cheong Poon 			__be32 addr4;
5821e2b44e7SKa-Cheong Poon 
5831e2b44e7SKa-Cheong Poon 			if (!(addr_type & IPV6_ADDR_MAPPED)) {
5841e2b44e7SKa-Cheong Poon 				ret = -EPROTOTYPE;
5851e2b44e7SKa-Cheong Poon 				break;
5861e2b44e7SKa-Cheong Poon 			}
5871e2b44e7SKa-Cheong Poon 
5881e2b44e7SKa-Cheong Poon 			/* It is a mapped address.  Need to do some sanity
5891e2b44e7SKa-Cheong Poon 			 * checks.
5901e2b44e7SKa-Cheong Poon 			 */
5911e2b44e7SKa-Cheong Poon 			addr4 = sin6->sin6_addr.s6_addr32[3];
5921e2b44e7SKa-Cheong Poon 			if (addr4 == htonl(INADDR_ANY) ||
5931e2b44e7SKa-Cheong Poon 			    addr4 == htonl(INADDR_BROADCAST) ||
594842841ecSDave Taht 			    ipv4_is_multicast(addr4)) {
5951e2b44e7SKa-Cheong Poon 				ret = -EPROTOTYPE;
5961e2b44e7SKa-Cheong Poon 				break;
5971e2b44e7SKa-Cheong Poon 			}
5981e2b44e7SKa-Cheong Poon 		}
5991e2b44e7SKa-Cheong Poon 
6001e2b44e7SKa-Cheong Poon 		if (addr_type & IPV6_ADDR_LINKLOCAL) {
6011e2b44e7SKa-Cheong Poon 			/* If socket is arleady bound to a link local address,
6021e2b44e7SKa-Cheong Poon 			 * the peer address must be on the same link.
6031e2b44e7SKa-Cheong Poon 			 */
6041e2b44e7SKa-Cheong Poon 			if (sin6->sin6_scope_id == 0 ||
6051e2b44e7SKa-Cheong Poon 			    (!ipv6_addr_any(&rs->rs_bound_addr) &&
6061e2b44e7SKa-Cheong Poon 			     rs->rs_bound_scope_id &&
6071e2b44e7SKa-Cheong Poon 			     sin6->sin6_scope_id != rs->rs_bound_scope_id)) {
6081e2b44e7SKa-Cheong Poon 				ret = -EINVAL;
6091e2b44e7SKa-Cheong Poon 				break;
6101e2b44e7SKa-Cheong Poon 			}
6111e2b44e7SKa-Cheong Poon 			/* Remember the connected address scope ID.  It will
6121e2b44e7SKa-Cheong Poon 			 * be checked against the binding local address when
6131e2b44e7SKa-Cheong Poon 			 * the socket is bound.
6141e2b44e7SKa-Cheong Poon 			 */
6151e2b44e7SKa-Cheong Poon 			rs->rs_bound_scope_id = sin6->sin6_scope_id;
6161e2b44e7SKa-Cheong Poon 		}
6171e2b44e7SKa-Cheong Poon 		rs->rs_conn_addr = sin6->sin6_addr;
6181e2b44e7SKa-Cheong Poon 		rs->rs_conn_port = sin6->sin6_port;
619eee2fa6aSKa-Cheong Poon 		break;
620e65d4d96SKa-Cheong Poon 	}
621e65d4d96SKa-Cheong Poon #endif
622eee2fa6aSKa-Cheong Poon 
623eee2fa6aSKa-Cheong Poon 	default:
6241e2b44e7SKa-Cheong Poon 		ret = -EAFNOSUPPORT;
625eee2fa6aSKa-Cheong Poon 		break;
626639b321bSAndy Grover 	}
627639b321bSAndy Grover 
628639b321bSAndy Grover 	release_sock(sk);
629639b321bSAndy Grover 	return ret;
630639b321bSAndy Grover }
631639b321bSAndy Grover 
632639b321bSAndy Grover static struct proto rds_proto = {
633639b321bSAndy Grover 	.name	  = "RDS",
634639b321bSAndy Grover 	.owner	  = THIS_MODULE,
635639b321bSAndy Grover 	.obj_size = sizeof(struct rds_sock),
636639b321bSAndy Grover };
637639b321bSAndy Grover 
6385708e868SAlexey Dobriyan static const struct proto_ops rds_proto_ops = {
639639b321bSAndy Grover 	.family =	AF_RDS,
640639b321bSAndy Grover 	.owner =	THIS_MODULE,
641639b321bSAndy Grover 	.release =	rds_release,
642639b321bSAndy Grover 	.bind =		rds_bind,
643639b321bSAndy Grover 	.connect =	rds_connect,
644639b321bSAndy Grover 	.socketpair =	sock_no_socketpair,
645639b321bSAndy Grover 	.accept =	sock_no_accept,
646639b321bSAndy Grover 	.getname =	rds_getname,
647639b321bSAndy Grover 	.poll =		rds_poll,
648639b321bSAndy Grover 	.ioctl =	rds_ioctl,
649639b321bSAndy Grover 	.listen =	sock_no_listen,
650639b321bSAndy Grover 	.shutdown =	sock_no_shutdown,
651639b321bSAndy Grover 	.setsockopt =	rds_setsockopt,
652639b321bSAndy Grover 	.getsockopt =	rds_getsockopt,
653639b321bSAndy Grover 	.sendmsg =	rds_sendmsg,
654639b321bSAndy Grover 	.recvmsg =	rds_recvmsg,
655639b321bSAndy Grover 	.mmap =		sock_no_mmap,
656639b321bSAndy Grover };
657639b321bSAndy Grover 
rds_sock_destruct(struct sock * sk)6580df5f9a6Ssantosh.shilimkar@oracle.com static void rds_sock_destruct(struct sock *sk)
6590df5f9a6Ssantosh.shilimkar@oracle.com {
6600df5f9a6Ssantosh.shilimkar@oracle.com 	struct rds_sock *rs = rds_sk_to_rs(sk);
6610df5f9a6Ssantosh.shilimkar@oracle.com 
6620df5f9a6Ssantosh.shilimkar@oracle.com 	WARN_ON((&rs->rs_item != rs->rs_item.next ||
6630df5f9a6Ssantosh.shilimkar@oracle.com 		 &rs->rs_item != rs->rs_item.prev));
6640df5f9a6Ssantosh.shilimkar@oracle.com }
6650df5f9a6Ssantosh.shilimkar@oracle.com 
__rds_create(struct socket * sock,struct sock * sk,int protocol)666639b321bSAndy Grover static int __rds_create(struct socket *sock, struct sock *sk, int protocol)
667639b321bSAndy Grover {
668639b321bSAndy Grover 	struct rds_sock *rs;
669639b321bSAndy Grover 
670639b321bSAndy Grover 	sock_init_data(sock, sk);
671639b321bSAndy Grover 	sock->ops		= &rds_proto_ops;
672639b321bSAndy Grover 	sk->sk_protocol		= protocol;
6730df5f9a6Ssantosh.shilimkar@oracle.com 	sk->sk_destruct		= rds_sock_destruct;
674639b321bSAndy Grover 
675639b321bSAndy Grover 	rs = rds_sk_to_rs(sk);
676639b321bSAndy Grover 	spin_lock_init(&rs->rs_lock);
677639b321bSAndy Grover 	rwlock_init(&rs->rs_recv_lock);
678639b321bSAndy Grover 	INIT_LIST_HEAD(&rs->rs_send_queue);
679639b321bSAndy Grover 	INIT_LIST_HEAD(&rs->rs_recv_queue);
680639b321bSAndy Grover 	INIT_LIST_HEAD(&rs->rs_notify_queue);
681639b321bSAndy Grover 	INIT_LIST_HEAD(&rs->rs_cong_list);
6829426bbc6SSowmini Varadhan 	rds_message_zcopy_queue_init(&rs->rs_zcookie_queue);
683639b321bSAndy Grover 	spin_lock_init(&rs->rs_rdma_lock);
684639b321bSAndy Grover 	rs->rs_rdma_keys = RB_ROOT;
6853289025aSSantosh Shilimkar 	rs->rs_rx_traces = 0;
6863eb45036SSantosh Shilimkar 	rs->rs_tos = 0;
6873eb45036SSantosh Shilimkar 	rs->rs_conn = NULL;
688639b321bSAndy Grover 
689efc3dbc3SDavid S. Miller 	spin_lock_bh(&rds_sock_lock);
690639b321bSAndy Grover 	list_add_tail(&rs->rs_item, &rds_sock_list);
691639b321bSAndy Grover 	rds_sock_count++;
692efc3dbc3SDavid S. Miller 	spin_unlock_bh(&rds_sock_lock);
693639b321bSAndy Grover 
694639b321bSAndy Grover 	return 0;
695639b321bSAndy Grover }
696639b321bSAndy Grover 
rds_create(struct net * net,struct socket * sock,int protocol,int kern)6973f378b68SEric Paris static int rds_create(struct net *net, struct socket *sock, int protocol,
6983f378b68SEric Paris 		      int kern)
699639b321bSAndy Grover {
700639b321bSAndy Grover 	struct sock *sk;
701639b321bSAndy Grover 
702639b321bSAndy Grover 	if (sock->type != SOCK_SEQPACKET || protocol)
703639b321bSAndy Grover 		return -ESOCKTNOSUPPORT;
704639b321bSAndy Grover 
705356feaadSChris Mason 	sk = sk_alloc(net, AF_RDS, GFP_KERNEL, &rds_proto, kern);
706639b321bSAndy Grover 	if (!sk)
707639b321bSAndy Grover 		return -ENOMEM;
708639b321bSAndy Grover 
709639b321bSAndy Grover 	return __rds_create(sock, sk, protocol);
710639b321bSAndy Grover }
711639b321bSAndy Grover 
rds_sock_addref(struct rds_sock * rs)712639b321bSAndy Grover void rds_sock_addref(struct rds_sock *rs)
713639b321bSAndy Grover {
714639b321bSAndy Grover 	sock_hold(rds_rs_to_sk(rs));
715639b321bSAndy Grover }
716639b321bSAndy Grover 
rds_sock_put(struct rds_sock * rs)717639b321bSAndy Grover void rds_sock_put(struct rds_sock *rs)
718639b321bSAndy Grover {
719639b321bSAndy Grover 	sock_put(rds_rs_to_sk(rs));
720639b321bSAndy Grover }
721639b321bSAndy Grover 
722ec1b4cf7SStephen Hemminger static const struct net_proto_family rds_family_ops = {
723639b321bSAndy Grover 	.family =	AF_RDS,
724639b321bSAndy Grover 	.create =	rds_create,
725639b321bSAndy Grover 	.owner	=	THIS_MODULE,
726639b321bSAndy Grover };
727639b321bSAndy Grover 
rds_sock_inc_info(struct socket * sock,unsigned int len,struct rds_info_iterator * iter,struct rds_info_lengths * lens)728639b321bSAndy Grover static void rds_sock_inc_info(struct socket *sock, unsigned int len,
729639b321bSAndy Grover 			      struct rds_info_iterator *iter,
730639b321bSAndy Grover 			      struct rds_info_lengths *lens)
731639b321bSAndy Grover {
732639b321bSAndy Grover 	struct rds_sock *rs;
733639b321bSAndy Grover 	struct rds_incoming *inc;
734639b321bSAndy Grover 	unsigned int total = 0;
735639b321bSAndy Grover 
736639b321bSAndy Grover 	len /= sizeof(struct rds_info_message);
737639b321bSAndy Grover 
738efc3dbc3SDavid S. Miller 	spin_lock_bh(&rds_sock_lock);
739639b321bSAndy Grover 
740639b321bSAndy Grover 	list_for_each_entry(rs, &rds_sock_list, rs_item) {
741a46b5b6cSKa-Cheong Poon 		/* This option only supports IPv4 sockets. */
742a46b5b6cSKa-Cheong Poon 		if (!ipv6_addr_v4mapped(&rs->rs_bound_addr))
743a46b5b6cSKa-Cheong Poon 			continue;
744a46b5b6cSKa-Cheong Poon 
745639b321bSAndy Grover 		read_lock(&rs->rs_recv_lock);
746639b321bSAndy Grover 
747639b321bSAndy Grover 		/* XXX too lazy to maintain counts.. */
748639b321bSAndy Grover 		list_for_each_entry(inc, &rs->rs_recv_queue, i_item) {
749639b321bSAndy Grover 			total++;
750639b321bSAndy Grover 			if (total <= len)
751eee2fa6aSKa-Cheong Poon 				rds_inc_info_copy(inc, iter,
752eee2fa6aSKa-Cheong Poon 						  inc->i_saddr.s6_addr32[3],
753eee2fa6aSKa-Cheong Poon 						  rs->rs_bound_addr_v4,
754eee2fa6aSKa-Cheong Poon 						  1);
755639b321bSAndy Grover 		}
756639b321bSAndy Grover 
757639b321bSAndy Grover 		read_unlock(&rs->rs_recv_lock);
758639b321bSAndy Grover 	}
759639b321bSAndy Grover 
760efc3dbc3SDavid S. Miller 	spin_unlock_bh(&rds_sock_lock);
761639b321bSAndy Grover 
762639b321bSAndy Grover 	lens->nr = total;
763639b321bSAndy Grover 	lens->each = sizeof(struct rds_info_message);
764639b321bSAndy Grover }
765639b321bSAndy Grover 
766a46b5b6cSKa-Cheong Poon #if IS_ENABLED(CONFIG_IPV6)
rds6_sock_inc_info(struct socket * sock,unsigned int len,struct rds_info_iterator * iter,struct rds_info_lengths * lens)767a46b5b6cSKa-Cheong Poon static void rds6_sock_inc_info(struct socket *sock, unsigned int len,
768a46b5b6cSKa-Cheong Poon 			       struct rds_info_iterator *iter,
769a46b5b6cSKa-Cheong Poon 			       struct rds_info_lengths *lens)
770a46b5b6cSKa-Cheong Poon {
771a46b5b6cSKa-Cheong Poon 	struct rds_incoming *inc;
772a46b5b6cSKa-Cheong Poon 	unsigned int total = 0;
773a46b5b6cSKa-Cheong Poon 	struct rds_sock *rs;
774a46b5b6cSKa-Cheong Poon 
775a46b5b6cSKa-Cheong Poon 	len /= sizeof(struct rds6_info_message);
776a46b5b6cSKa-Cheong Poon 
777a46b5b6cSKa-Cheong Poon 	spin_lock_bh(&rds_sock_lock);
778a46b5b6cSKa-Cheong Poon 
779a46b5b6cSKa-Cheong Poon 	list_for_each_entry(rs, &rds_sock_list, rs_item) {
780a46b5b6cSKa-Cheong Poon 		read_lock(&rs->rs_recv_lock);
781a46b5b6cSKa-Cheong Poon 
782a46b5b6cSKa-Cheong Poon 		list_for_each_entry(inc, &rs->rs_recv_queue, i_item) {
783a46b5b6cSKa-Cheong Poon 			total++;
784a46b5b6cSKa-Cheong Poon 			if (total <= len)
785a46b5b6cSKa-Cheong Poon 				rds6_inc_info_copy(inc, iter, &inc->i_saddr,
786a46b5b6cSKa-Cheong Poon 						   &rs->rs_bound_addr, 1);
787a46b5b6cSKa-Cheong Poon 		}
788a46b5b6cSKa-Cheong Poon 
789a46b5b6cSKa-Cheong Poon 		read_unlock(&rs->rs_recv_lock);
790a46b5b6cSKa-Cheong Poon 	}
791a46b5b6cSKa-Cheong Poon 
792a46b5b6cSKa-Cheong Poon 	spin_unlock_bh(&rds_sock_lock);
793a46b5b6cSKa-Cheong Poon 
794a46b5b6cSKa-Cheong Poon 	lens->nr = total;
795a46b5b6cSKa-Cheong Poon 	lens->each = sizeof(struct rds6_info_message);
796a46b5b6cSKa-Cheong Poon }
797a46b5b6cSKa-Cheong Poon #endif
798a46b5b6cSKa-Cheong Poon 
rds_sock_info(struct socket * sock,unsigned int len,struct rds_info_iterator * iter,struct rds_info_lengths * lens)799639b321bSAndy Grover static void rds_sock_info(struct socket *sock, unsigned int len,
800639b321bSAndy Grover 			  struct rds_info_iterator *iter,
801639b321bSAndy Grover 			  struct rds_info_lengths *lens)
802639b321bSAndy Grover {
803639b321bSAndy Grover 	struct rds_info_socket sinfo;
804a46b5b6cSKa-Cheong Poon 	unsigned int cnt = 0;
805639b321bSAndy Grover 	struct rds_sock *rs;
806639b321bSAndy Grover 
807639b321bSAndy Grover 	len /= sizeof(struct rds_info_socket);
808639b321bSAndy Grover 
809efc3dbc3SDavid S. Miller 	spin_lock_bh(&rds_sock_lock);
810639b321bSAndy Grover 
811a46b5b6cSKa-Cheong Poon 	if (len < rds_sock_count) {
812a46b5b6cSKa-Cheong Poon 		cnt = rds_sock_count;
813639b321bSAndy Grover 		goto out;
814a46b5b6cSKa-Cheong Poon 	}
815639b321bSAndy Grover 
816639b321bSAndy Grover 	list_for_each_entry(rs, &rds_sock_list, rs_item) {
817a46b5b6cSKa-Cheong Poon 		/* This option only supports IPv4 sockets. */
818a46b5b6cSKa-Cheong Poon 		if (!ipv6_addr_v4mapped(&rs->rs_bound_addr))
819a46b5b6cSKa-Cheong Poon 			continue;
820639b321bSAndy Grover 		sinfo.sndbuf = rds_sk_sndbuf(rs);
821639b321bSAndy Grover 		sinfo.rcvbuf = rds_sk_rcvbuf(rs);
822eee2fa6aSKa-Cheong Poon 		sinfo.bound_addr = rs->rs_bound_addr_v4;
823eee2fa6aSKa-Cheong Poon 		sinfo.connected_addr = rs->rs_conn_addr_v4;
824639b321bSAndy Grover 		sinfo.bound_port = rs->rs_bound_port;
825639b321bSAndy Grover 		sinfo.connected_port = rs->rs_conn_port;
826639b321bSAndy Grover 		sinfo.inum = sock_i_ino(rds_rs_to_sk(rs));
827639b321bSAndy Grover 
828639b321bSAndy Grover 		rds_info_copy(iter, &sinfo, sizeof(sinfo));
829a46b5b6cSKa-Cheong Poon 		cnt++;
830639b321bSAndy Grover 	}
831639b321bSAndy Grover 
832639b321bSAndy Grover out:
833a46b5b6cSKa-Cheong Poon 	lens->nr = cnt;
834639b321bSAndy Grover 	lens->each = sizeof(struct rds_info_socket);
835639b321bSAndy Grover 
836efc3dbc3SDavid S. Miller 	spin_unlock_bh(&rds_sock_lock);
837639b321bSAndy Grover }
838639b321bSAndy Grover 
839a46b5b6cSKa-Cheong Poon #if IS_ENABLED(CONFIG_IPV6)
rds6_sock_info(struct socket * sock,unsigned int len,struct rds_info_iterator * iter,struct rds_info_lengths * lens)840a46b5b6cSKa-Cheong Poon static void rds6_sock_info(struct socket *sock, unsigned int len,
841a46b5b6cSKa-Cheong Poon 			   struct rds_info_iterator *iter,
842a46b5b6cSKa-Cheong Poon 			   struct rds_info_lengths *lens)
843a46b5b6cSKa-Cheong Poon {
844a46b5b6cSKa-Cheong Poon 	struct rds6_info_socket sinfo6;
845a46b5b6cSKa-Cheong Poon 	struct rds_sock *rs;
846a46b5b6cSKa-Cheong Poon 
847a46b5b6cSKa-Cheong Poon 	len /= sizeof(struct rds6_info_socket);
848a46b5b6cSKa-Cheong Poon 
849a46b5b6cSKa-Cheong Poon 	spin_lock_bh(&rds_sock_lock);
850a46b5b6cSKa-Cheong Poon 
851a46b5b6cSKa-Cheong Poon 	if (len < rds_sock_count)
852a46b5b6cSKa-Cheong Poon 		goto out;
853a46b5b6cSKa-Cheong Poon 
854a46b5b6cSKa-Cheong Poon 	list_for_each_entry(rs, &rds_sock_list, rs_item) {
855a46b5b6cSKa-Cheong Poon 		sinfo6.sndbuf = rds_sk_sndbuf(rs);
856a46b5b6cSKa-Cheong Poon 		sinfo6.rcvbuf = rds_sk_rcvbuf(rs);
857a46b5b6cSKa-Cheong Poon 		sinfo6.bound_addr = rs->rs_bound_addr;
858a46b5b6cSKa-Cheong Poon 		sinfo6.connected_addr = rs->rs_conn_addr;
859a46b5b6cSKa-Cheong Poon 		sinfo6.bound_port = rs->rs_bound_port;
860a46b5b6cSKa-Cheong Poon 		sinfo6.connected_port = rs->rs_conn_port;
861a46b5b6cSKa-Cheong Poon 		sinfo6.inum = sock_i_ino(rds_rs_to_sk(rs));
862a46b5b6cSKa-Cheong Poon 
863a46b5b6cSKa-Cheong Poon 		rds_info_copy(iter, &sinfo6, sizeof(sinfo6));
864a46b5b6cSKa-Cheong Poon 	}
865a46b5b6cSKa-Cheong Poon 
866a46b5b6cSKa-Cheong Poon  out:
867a46b5b6cSKa-Cheong Poon 	lens->nr = rds_sock_count;
868a46b5b6cSKa-Cheong Poon 	lens->each = sizeof(struct rds6_info_socket);
869a46b5b6cSKa-Cheong Poon 
870a46b5b6cSKa-Cheong Poon 	spin_unlock_bh(&rds_sock_lock);
871a46b5b6cSKa-Cheong Poon }
872a46b5b6cSKa-Cheong Poon #endif
873a46b5b6cSKa-Cheong Poon 
rds_exit(void)874ef87b7eaSZach Brown static void rds_exit(void)
875639b321bSAndy Grover {
876639b321bSAndy Grover 	sock_unregister(rds_family_ops.family);
877639b321bSAndy Grover 	proto_unregister(&rds_proto);
878639b321bSAndy Grover 	rds_conn_exit();
879639b321bSAndy Grover 	rds_cong_exit();
880639b321bSAndy Grover 	rds_sysctl_exit();
881639b321bSAndy Grover 	rds_threads_exit();
882639b321bSAndy Grover 	rds_stats_exit();
883639b321bSAndy Grover 	rds_page_exit();
8847b565434Ssantosh.shilimkar@oracle.com 	rds_bind_lock_destroy();
885639b321bSAndy Grover 	rds_info_deregister_func(RDS_INFO_SOCKETS, rds_sock_info);
886639b321bSAndy Grover 	rds_info_deregister_func(RDS_INFO_RECV_MESSAGES, rds_sock_inc_info);
887a46b5b6cSKa-Cheong Poon #if IS_ENABLED(CONFIG_IPV6)
888a46b5b6cSKa-Cheong Poon 	rds_info_deregister_func(RDS6_INFO_SOCKETS, rds6_sock_info);
889a46b5b6cSKa-Cheong Poon 	rds_info_deregister_func(RDS6_INFO_RECV_MESSAGES, rds6_sock_inc_info);
890a46b5b6cSKa-Cheong Poon #endif
891639b321bSAndy Grover }
892639b321bSAndy Grover module_exit(rds_exit);
893639b321bSAndy Grover 
894905dd418SSowmini Varadhan u32 rds_gen_num;
895905dd418SSowmini Varadhan 
rds_init(void)896f0bd32c8SXiu Jianfeng static int __init rds_init(void)
897639b321bSAndy Grover {
898639b321bSAndy Grover 	int ret;
899639b321bSAndy Grover 
900905dd418SSowmini Varadhan 	net_get_random_once(&rds_gen_num, sizeof(rds_gen_num));
901905dd418SSowmini Varadhan 
9027b565434Ssantosh.shilimkar@oracle.com 	ret = rds_bind_lock_init();
9037b565434Ssantosh.shilimkar@oracle.com 	if (ret)
9047b565434Ssantosh.shilimkar@oracle.com 		goto out;
9059b9acde7SSantosh Shilimkar 
906639b321bSAndy Grover 	ret = rds_conn_init();
907639b321bSAndy Grover 	if (ret)
9087b565434Ssantosh.shilimkar@oracle.com 		goto out_bind;
9097b565434Ssantosh.shilimkar@oracle.com 
910639b321bSAndy Grover 	ret = rds_threads_init();
911639b321bSAndy Grover 	if (ret)
912639b321bSAndy Grover 		goto out_conn;
913639b321bSAndy Grover 	ret = rds_sysctl_init();
914639b321bSAndy Grover 	if (ret)
915639b321bSAndy Grover 		goto out_threads;
916639b321bSAndy Grover 	ret = rds_stats_init();
917639b321bSAndy Grover 	if (ret)
918639b321bSAndy Grover 		goto out_sysctl;
919639b321bSAndy Grover 	ret = proto_register(&rds_proto, 1);
920639b321bSAndy Grover 	if (ret)
921639b321bSAndy Grover 		goto out_stats;
922639b321bSAndy Grover 	ret = sock_register(&rds_family_ops);
923639b321bSAndy Grover 	if (ret)
924639b321bSAndy Grover 		goto out_proto;
925639b321bSAndy Grover 
926639b321bSAndy Grover 	rds_info_register_func(RDS_INFO_SOCKETS, rds_sock_info);
927639b321bSAndy Grover 	rds_info_register_func(RDS_INFO_RECV_MESSAGES, rds_sock_inc_info);
928a46b5b6cSKa-Cheong Poon #if IS_ENABLED(CONFIG_IPV6)
929a46b5b6cSKa-Cheong Poon 	rds_info_register_func(RDS6_INFO_SOCKETS, rds6_sock_info);
930a46b5b6cSKa-Cheong Poon 	rds_info_register_func(RDS6_INFO_RECV_MESSAGES, rds6_sock_inc_info);
931a46b5b6cSKa-Cheong Poon #endif
932639b321bSAndy Grover 
933639b321bSAndy Grover 	goto out;
934639b321bSAndy Grover 
935639b321bSAndy Grover out_proto:
936639b321bSAndy Grover 	proto_unregister(&rds_proto);
937639b321bSAndy Grover out_stats:
938639b321bSAndy Grover 	rds_stats_exit();
939639b321bSAndy Grover out_sysctl:
940639b321bSAndy Grover 	rds_sysctl_exit();
941639b321bSAndy Grover out_threads:
942639b321bSAndy Grover 	rds_threads_exit();
943639b321bSAndy Grover out_conn:
944639b321bSAndy Grover 	rds_conn_exit();
945639b321bSAndy Grover 	rds_cong_exit();
946639b321bSAndy Grover 	rds_page_exit();
9477b565434Ssantosh.shilimkar@oracle.com out_bind:
9487b565434Ssantosh.shilimkar@oracle.com 	rds_bind_lock_destroy();
949639b321bSAndy Grover out:
950639b321bSAndy Grover 	return ret;
951639b321bSAndy Grover }
952639b321bSAndy Grover module_init(rds_init);
953639b321bSAndy Grover 
954639b321bSAndy Grover #define DRV_VERSION     "4.0"
955639b321bSAndy Grover #define DRV_RELDATE     "Feb 12, 2009"
956639b321bSAndy Grover 
957639b321bSAndy Grover MODULE_AUTHOR("Oracle Corporation <rds-devel@oss.oracle.com>");
958639b321bSAndy Grover MODULE_DESCRIPTION("RDS: Reliable Datagram Sockets"
959639b321bSAndy Grover 		   " v" DRV_VERSION " (" DRV_RELDATE ")");
960639b321bSAndy Grover MODULE_VERSION(DRV_VERSION);
961639b321bSAndy Grover MODULE_LICENSE("Dual BSD/GPL");
962639b321bSAndy Grover MODULE_ALIAS_NETPROTO(PF_RDS);
963