Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 1 | /* |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 2 | * Copyright (c) 2006, 2019 Oracle and/or its affiliates. All rights reserved. |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 3 | * |
| 4 | * This software is available to you under a choice of one of two |
| 5 | * licenses. You may choose to be licensed under the terms of the GNU |
| 6 | * General Public License (GPL) Version 2, available from the file |
| 7 | * COPYING in the main directory of this source tree, or the |
| 8 | * OpenIB.org BSD license below: |
| 9 | * |
| 10 | * Redistribution and use in source and binary forms, with or |
| 11 | * without modification, are permitted provided that the following |
| 12 | * conditions are met: |
| 13 | * |
| 14 | * - Redistributions of source code must retain the above |
| 15 | * copyright notice, this list of conditions and the following |
| 16 | * disclaimer. |
| 17 | * |
| 18 | * - Redistributions in binary form must reproduce the above |
| 19 | * copyright notice, this list of conditions and the following |
| 20 | * disclaimer in the documentation and/or other materials |
| 21 | * provided with the distribution. |
| 22 | * |
| 23 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 24 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 25 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| 26 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
| 27 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| 29 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| 30 | * SOFTWARE. |
| 31 | * |
| 32 | */ |
| 33 | #include <linux/module.h> |
| 34 | #include <linux/errno.h> |
| 35 | #include <linux/kernel.h> |
| 36 | #include <linux/gfp.h> |
| 37 | #include <linux/in.h> |
| 38 | #include <linux/ipv6.h> |
| 39 | #include <linux/poll.h> |
| 40 | #include <net/sock.h> |
| 41 | |
| 42 | #include "rds.h" |
| 43 | |
| 44 | /* this is just used for stats gathering :/ */ |
| 45 | static DEFINE_SPINLOCK(rds_sock_lock); |
| 46 | static unsigned long rds_sock_count; |
| 47 | static LIST_HEAD(rds_sock_list); |
| 48 | DECLARE_WAIT_QUEUE_HEAD(rds_poll_waitq); |
| 49 | |
| 50 | /* |
| 51 | * This is called as the final descriptor referencing this socket is closed. |
| 52 | * We have to unbind the socket so that another socket can be bound to the |
| 53 | * address it was using. |
| 54 | * |
| 55 | * We have to be careful about racing with the incoming path. sock_orphan() |
| 56 | * sets SOCK_DEAD and we use that as an indicator to the rx path that new |
| 57 | * messages shouldn't be queued. |
| 58 | */ |
| 59 | static int rds_release(struct socket *sock) |
| 60 | { |
| 61 | struct sock *sk = sock->sk; |
| 62 | struct rds_sock *rs; |
| 63 | |
| 64 | if (!sk) |
| 65 | goto out; |
| 66 | |
| 67 | rs = rds_sk_to_rs(sk); |
| 68 | |
| 69 | sock_orphan(sk); |
| 70 | /* Note - rds_clear_recv_queue grabs rs_recv_lock, so |
| 71 | * that ensures the recv path has completed messing |
| 72 | * with the socket. */ |
| 73 | rds_clear_recv_queue(rs); |
| 74 | rds_cong_remove_socket(rs); |
| 75 | |
| 76 | rds_remove_bound(rs); |
| 77 | |
| 78 | rds_send_drop_to(rs, NULL); |
| 79 | rds_rdma_drop_keys(rs); |
| 80 | rds_notify_queue_get(rs, NULL); |
| 81 | rds_notify_msg_zcopy_purge(&rs->rs_zcookie_queue); |
| 82 | |
| 83 | spin_lock_bh(&rds_sock_lock); |
| 84 | list_del_init(&rs->rs_item); |
| 85 | rds_sock_count--; |
| 86 | spin_unlock_bh(&rds_sock_lock); |
| 87 | |
| 88 | rds_trans_put(rs->rs_transport); |
| 89 | |
| 90 | sock->sk = NULL; |
| 91 | sock_put(sk); |
| 92 | out: |
| 93 | return 0; |
| 94 | } |
| 95 | |
| 96 | /* |
| 97 | * Careful not to race with rds_release -> sock_orphan which clears sk_sleep. |
| 98 | * _bh() isn't OK here, we're called from interrupt handlers. It's probably OK |
| 99 | * to wake the waitqueue after sk_sleep is clear as we hold a sock ref, but |
| 100 | * this seems more conservative. |
| 101 | * NB - normally, one would use sk_callback_lock for this, but we can |
| 102 | * get here from interrupts, whereas the network code grabs sk_callback_lock |
| 103 | * with _lock_bh only - so relying on sk_callback_lock introduces livelocks. |
| 104 | */ |
| 105 | void rds_wake_sk_sleep(struct rds_sock *rs) |
| 106 | { |
| 107 | unsigned long flags; |
| 108 | |
| 109 | read_lock_irqsave(&rs->rs_recv_lock, flags); |
| 110 | __rds_wake_sk_sleep(rds_rs_to_sk(rs)); |
| 111 | read_unlock_irqrestore(&rs->rs_recv_lock, flags); |
| 112 | } |
| 113 | |
| 114 | static int rds_getname(struct socket *sock, struct sockaddr *uaddr, |
| 115 | int peer) |
| 116 | { |
| 117 | struct rds_sock *rs = rds_sk_to_rs(sock->sk); |
| 118 | struct sockaddr_in6 *sin6; |
| 119 | struct sockaddr_in *sin; |
| 120 | int uaddr_len; |
| 121 | |
| 122 | /* racey, don't care */ |
| 123 | if (peer) { |
| 124 | if (ipv6_addr_any(&rs->rs_conn_addr)) |
| 125 | return -ENOTCONN; |
| 126 | |
| 127 | if (ipv6_addr_v4mapped(&rs->rs_conn_addr)) { |
| 128 | sin = (struct sockaddr_in *)uaddr; |
| 129 | memset(sin->sin_zero, 0, sizeof(sin->sin_zero)); |
| 130 | sin->sin_family = AF_INET; |
| 131 | sin->sin_port = rs->rs_conn_port; |
| 132 | sin->sin_addr.s_addr = rs->rs_conn_addr_v4; |
| 133 | uaddr_len = sizeof(*sin); |
| 134 | } else { |
| 135 | sin6 = (struct sockaddr_in6 *)uaddr; |
| 136 | sin6->sin6_family = AF_INET6; |
| 137 | sin6->sin6_port = rs->rs_conn_port; |
| 138 | sin6->sin6_addr = rs->rs_conn_addr; |
| 139 | sin6->sin6_flowinfo = 0; |
| 140 | /* scope_id is the same as in the bound address. */ |
| 141 | sin6->sin6_scope_id = rs->rs_bound_scope_id; |
| 142 | uaddr_len = sizeof(*sin6); |
| 143 | } |
| 144 | } else { |
| 145 | /* If socket is not yet bound and the socket is connected, |
| 146 | * set the return address family to be the same as the |
| 147 | * connected address, but with 0 address value. If it is not |
| 148 | * connected, set the family to be AF_UNSPEC (value 0) and |
| 149 | * the address size to be that of an IPv4 address. |
| 150 | */ |
| 151 | if (ipv6_addr_any(&rs->rs_bound_addr)) { |
| 152 | if (ipv6_addr_any(&rs->rs_conn_addr)) { |
| 153 | sin = (struct sockaddr_in *)uaddr; |
| 154 | memset(sin, 0, sizeof(*sin)); |
| 155 | sin->sin_family = AF_UNSPEC; |
| 156 | return sizeof(*sin); |
| 157 | } |
| 158 | |
| 159 | #if IS_ENABLED(CONFIG_IPV6) |
| 160 | if (!(ipv6_addr_type(&rs->rs_conn_addr) & |
| 161 | IPV6_ADDR_MAPPED)) { |
| 162 | sin6 = (struct sockaddr_in6 *)uaddr; |
| 163 | memset(sin6, 0, sizeof(*sin6)); |
| 164 | sin6->sin6_family = AF_INET6; |
| 165 | return sizeof(*sin6); |
| 166 | } |
| 167 | #endif |
| 168 | |
| 169 | sin = (struct sockaddr_in *)uaddr; |
| 170 | memset(sin, 0, sizeof(*sin)); |
| 171 | sin->sin_family = AF_INET; |
| 172 | return sizeof(*sin); |
| 173 | } |
| 174 | if (ipv6_addr_v4mapped(&rs->rs_bound_addr)) { |
| 175 | sin = (struct sockaddr_in *)uaddr; |
| 176 | memset(sin->sin_zero, 0, sizeof(sin->sin_zero)); |
| 177 | sin->sin_family = AF_INET; |
| 178 | sin->sin_port = rs->rs_bound_port; |
| 179 | sin->sin_addr.s_addr = rs->rs_bound_addr_v4; |
| 180 | uaddr_len = sizeof(*sin); |
| 181 | } else { |
| 182 | sin6 = (struct sockaddr_in6 *)uaddr; |
| 183 | sin6->sin6_family = AF_INET6; |
| 184 | sin6->sin6_port = rs->rs_bound_port; |
| 185 | sin6->sin6_addr = rs->rs_bound_addr; |
| 186 | sin6->sin6_flowinfo = 0; |
| 187 | sin6->sin6_scope_id = rs->rs_bound_scope_id; |
| 188 | uaddr_len = sizeof(*sin6); |
| 189 | } |
| 190 | } |
| 191 | |
| 192 | return uaddr_len; |
| 193 | } |
| 194 | |
| 195 | /* |
| 196 | * RDS' poll is without a doubt the least intuitive part of the interface, |
| 197 | * as EPOLLIN and EPOLLOUT do not behave entirely as you would expect from |
| 198 | * a network protocol. |
| 199 | * |
| 200 | * EPOLLIN is asserted if |
| 201 | * - there is data on the receive queue. |
| 202 | * - to signal that a previously congested destination may have become |
| 203 | * uncongested |
| 204 | * - A notification has been queued to the socket (this can be a congestion |
| 205 | * update, or a RDMA completion, or a MSG_ZEROCOPY completion). |
| 206 | * |
| 207 | * EPOLLOUT is asserted if there is room on the send queue. This does not mean |
| 208 | * however, that the next sendmsg() call will succeed. If the application tries |
| 209 | * to send to a congested destination, the system call may still fail (and |
| 210 | * return ENOBUFS). |
| 211 | */ |
| 212 | static __poll_t rds_poll(struct file *file, struct socket *sock, |
| 213 | poll_table *wait) |
| 214 | { |
| 215 | struct sock *sk = sock->sk; |
| 216 | struct rds_sock *rs = rds_sk_to_rs(sk); |
| 217 | __poll_t mask = 0; |
| 218 | unsigned long flags; |
| 219 | |
| 220 | poll_wait(file, sk_sleep(sk), wait); |
| 221 | |
| 222 | if (rs->rs_seen_congestion) |
| 223 | poll_wait(file, &rds_poll_waitq, wait); |
| 224 | |
| 225 | read_lock_irqsave(&rs->rs_recv_lock, flags); |
| 226 | if (!rs->rs_cong_monitor) { |
| 227 | /* When a congestion map was updated, we signal EPOLLIN for |
| 228 | * "historical" reasons. Applications can also poll for |
| 229 | * WRBAND instead. */ |
| 230 | if (rds_cong_updated_since(&rs->rs_cong_track)) |
| 231 | mask |= (EPOLLIN | EPOLLRDNORM | EPOLLWRBAND); |
| 232 | } else { |
| 233 | spin_lock(&rs->rs_lock); |
| 234 | if (rs->rs_cong_notify) |
| 235 | mask |= (EPOLLIN | EPOLLRDNORM); |
| 236 | spin_unlock(&rs->rs_lock); |
| 237 | } |
| 238 | if (!list_empty(&rs->rs_recv_queue) || |
| 239 | !list_empty(&rs->rs_notify_queue) || |
| 240 | !list_empty(&rs->rs_zcookie_queue.zcookie_head)) |
| 241 | mask |= (EPOLLIN | EPOLLRDNORM); |
| 242 | if (rs->rs_snd_bytes < rds_sk_sndbuf(rs)) |
| 243 | mask |= (EPOLLOUT | EPOLLWRNORM); |
| 244 | if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue)) |
| 245 | mask |= POLLERR; |
| 246 | read_unlock_irqrestore(&rs->rs_recv_lock, flags); |
| 247 | |
| 248 | /* clear state any time we wake a seen-congested socket */ |
| 249 | if (mask) |
| 250 | rs->rs_seen_congestion = 0; |
| 251 | |
| 252 | return mask; |
| 253 | } |
| 254 | |
| 255 | static int rds_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) |
| 256 | { |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 257 | struct rds_sock *rs = rds_sk_to_rs(sock->sk); |
| 258 | rds_tos_t utos, tos = 0; |
| 259 | |
| 260 | switch (cmd) { |
| 261 | case SIOCRDSSETTOS: |
| 262 | if (get_user(utos, (rds_tos_t __user *)arg)) |
| 263 | return -EFAULT; |
| 264 | |
| 265 | if (rs->rs_transport && |
| 266 | rs->rs_transport->get_tos_map) |
| 267 | tos = rs->rs_transport->get_tos_map(utos); |
| 268 | else |
| 269 | return -ENOIOCTLCMD; |
| 270 | |
| 271 | spin_lock_bh(&rds_sock_lock); |
| 272 | if (rs->rs_tos || rs->rs_conn) { |
| 273 | spin_unlock_bh(&rds_sock_lock); |
| 274 | return -EINVAL; |
| 275 | } |
| 276 | rs->rs_tos = tos; |
| 277 | spin_unlock_bh(&rds_sock_lock); |
| 278 | break; |
| 279 | case SIOCRDSGETTOS: |
| 280 | spin_lock_bh(&rds_sock_lock); |
| 281 | tos = rs->rs_tos; |
| 282 | spin_unlock_bh(&rds_sock_lock); |
| 283 | if (put_user(tos, (rds_tos_t __user *)arg)) |
| 284 | return -EFAULT; |
| 285 | break; |
| 286 | default: |
| 287 | return -ENOIOCTLCMD; |
| 288 | } |
| 289 | |
| 290 | return 0; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 291 | } |
| 292 | |
| 293 | static int rds_cancel_sent_to(struct rds_sock *rs, char __user *optval, |
| 294 | int len) |
| 295 | { |
| 296 | struct sockaddr_in6 sin6; |
| 297 | struct sockaddr_in sin; |
| 298 | int ret = 0; |
| 299 | |
| 300 | /* racing with another thread binding seems ok here */ |
| 301 | if (ipv6_addr_any(&rs->rs_bound_addr)) { |
| 302 | ret = -ENOTCONN; /* XXX not a great errno */ |
| 303 | goto out; |
| 304 | } |
| 305 | |
| 306 | if (len < sizeof(struct sockaddr_in)) { |
| 307 | ret = -EINVAL; |
| 308 | goto out; |
| 309 | } else if (len < sizeof(struct sockaddr_in6)) { |
| 310 | /* Assume IPv4 */ |
| 311 | if (copy_from_user(&sin, optval, sizeof(struct sockaddr_in))) { |
| 312 | ret = -EFAULT; |
| 313 | goto out; |
| 314 | } |
| 315 | ipv6_addr_set_v4mapped(sin.sin_addr.s_addr, &sin6.sin6_addr); |
| 316 | sin6.sin6_port = sin.sin_port; |
| 317 | } else { |
| 318 | if (copy_from_user(&sin6, optval, |
| 319 | sizeof(struct sockaddr_in6))) { |
| 320 | ret = -EFAULT; |
| 321 | goto out; |
| 322 | } |
| 323 | } |
| 324 | |
| 325 | rds_send_drop_to(rs, &sin6); |
| 326 | out: |
| 327 | return ret; |
| 328 | } |
| 329 | |
| 330 | static int rds_set_bool_option(unsigned char *optvar, char __user *optval, |
| 331 | int optlen) |
| 332 | { |
| 333 | int value; |
| 334 | |
| 335 | if (optlen < sizeof(int)) |
| 336 | return -EINVAL; |
| 337 | if (get_user(value, (int __user *) optval)) |
| 338 | return -EFAULT; |
| 339 | *optvar = !!value; |
| 340 | return 0; |
| 341 | } |
| 342 | |
| 343 | static int rds_cong_monitor(struct rds_sock *rs, char __user *optval, |
| 344 | int optlen) |
| 345 | { |
| 346 | int ret; |
| 347 | |
| 348 | ret = rds_set_bool_option(&rs->rs_cong_monitor, optval, optlen); |
| 349 | if (ret == 0) { |
| 350 | if (rs->rs_cong_monitor) { |
| 351 | rds_cong_add_socket(rs); |
| 352 | } else { |
| 353 | rds_cong_remove_socket(rs); |
| 354 | rs->rs_cong_mask = 0; |
| 355 | rs->rs_cong_notify = 0; |
| 356 | } |
| 357 | } |
| 358 | return ret; |
| 359 | } |
| 360 | |
| 361 | static int rds_set_transport(struct rds_sock *rs, char __user *optval, |
| 362 | int optlen) |
| 363 | { |
| 364 | int t_type; |
| 365 | |
| 366 | if (rs->rs_transport) |
| 367 | return -EOPNOTSUPP; /* previously attached to transport */ |
| 368 | |
| 369 | if (optlen != sizeof(int)) |
| 370 | return -EINVAL; |
| 371 | |
| 372 | if (copy_from_user(&t_type, (int __user *)optval, sizeof(t_type))) |
| 373 | return -EFAULT; |
| 374 | |
| 375 | if (t_type < 0 || t_type >= RDS_TRANS_COUNT) |
| 376 | return -EINVAL; |
| 377 | |
| 378 | rs->rs_transport = rds_trans_get(t_type); |
| 379 | |
| 380 | return rs->rs_transport ? 0 : -ENOPROTOOPT; |
| 381 | } |
| 382 | |
| 383 | static int rds_enable_recvtstamp(struct sock *sk, char __user *optval, |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 384 | int optlen, int optname) |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 385 | { |
| 386 | int val, valbool; |
| 387 | |
| 388 | if (optlen != sizeof(int)) |
| 389 | return -EFAULT; |
| 390 | |
| 391 | if (get_user(val, (int __user *)optval)) |
| 392 | return -EFAULT; |
| 393 | |
| 394 | valbool = val ? 1 : 0; |
| 395 | |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 396 | if (optname == SO_TIMESTAMP_NEW) |
| 397 | sock_set_flag(sk, SOCK_TSTAMP_NEW); |
| 398 | |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 399 | if (valbool) |
| 400 | sock_set_flag(sk, SOCK_RCVTSTAMP); |
| 401 | else |
| 402 | sock_reset_flag(sk, SOCK_RCVTSTAMP); |
| 403 | |
| 404 | return 0; |
| 405 | } |
| 406 | |
| 407 | static int rds_recv_track_latency(struct rds_sock *rs, char __user *optval, |
| 408 | int optlen) |
| 409 | { |
| 410 | struct rds_rx_trace_so trace; |
| 411 | int i; |
| 412 | |
| 413 | if (optlen != sizeof(struct rds_rx_trace_so)) |
| 414 | return -EFAULT; |
| 415 | |
| 416 | if (copy_from_user(&trace, optval, sizeof(trace))) |
| 417 | return -EFAULT; |
| 418 | |
| 419 | if (trace.rx_traces > RDS_MSG_RX_DGRAM_TRACE_MAX) |
| 420 | return -EFAULT; |
| 421 | |
| 422 | rs->rs_rx_traces = trace.rx_traces; |
| 423 | for (i = 0; i < rs->rs_rx_traces; i++) { |
| 424 | if (trace.rx_trace_pos[i] > RDS_MSG_RX_DGRAM_TRACE_MAX) { |
| 425 | rs->rs_rx_traces = 0; |
| 426 | return -EFAULT; |
| 427 | } |
| 428 | rs->rs_rx_trace[i] = trace.rx_trace_pos[i]; |
| 429 | } |
| 430 | |
| 431 | return 0; |
| 432 | } |
| 433 | |
| 434 | static int rds_setsockopt(struct socket *sock, int level, int optname, |
| 435 | char __user *optval, unsigned int optlen) |
| 436 | { |
| 437 | struct rds_sock *rs = rds_sk_to_rs(sock->sk); |
| 438 | int ret; |
| 439 | |
| 440 | if (level != SOL_RDS) { |
| 441 | ret = -ENOPROTOOPT; |
| 442 | goto out; |
| 443 | } |
| 444 | |
| 445 | switch (optname) { |
| 446 | case RDS_CANCEL_SENT_TO: |
| 447 | ret = rds_cancel_sent_to(rs, optval, optlen); |
| 448 | break; |
| 449 | case RDS_GET_MR: |
| 450 | ret = rds_get_mr(rs, optval, optlen); |
| 451 | break; |
| 452 | case RDS_GET_MR_FOR_DEST: |
| 453 | ret = rds_get_mr_for_dest(rs, optval, optlen); |
| 454 | break; |
| 455 | case RDS_FREE_MR: |
| 456 | ret = rds_free_mr(rs, optval, optlen); |
| 457 | break; |
| 458 | case RDS_RECVERR: |
| 459 | ret = rds_set_bool_option(&rs->rs_recverr, optval, optlen); |
| 460 | break; |
| 461 | case RDS_CONG_MONITOR: |
| 462 | ret = rds_cong_monitor(rs, optval, optlen); |
| 463 | break; |
| 464 | case SO_RDS_TRANSPORT: |
| 465 | lock_sock(sock->sk); |
| 466 | ret = rds_set_transport(rs, optval, optlen); |
| 467 | release_sock(sock->sk); |
| 468 | break; |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 469 | case SO_TIMESTAMP_OLD: |
| 470 | case SO_TIMESTAMP_NEW: |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 471 | lock_sock(sock->sk); |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 472 | ret = rds_enable_recvtstamp(sock->sk, optval, optlen, optname); |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 473 | release_sock(sock->sk); |
| 474 | break; |
| 475 | case SO_RDS_MSG_RXPATH_LATENCY: |
| 476 | ret = rds_recv_track_latency(rs, optval, optlen); |
| 477 | break; |
| 478 | default: |
| 479 | ret = -ENOPROTOOPT; |
| 480 | } |
| 481 | out: |
| 482 | return ret; |
| 483 | } |
| 484 | |
| 485 | static int rds_getsockopt(struct socket *sock, int level, int optname, |
| 486 | char __user *optval, int __user *optlen) |
| 487 | { |
| 488 | struct rds_sock *rs = rds_sk_to_rs(sock->sk); |
| 489 | int ret = -ENOPROTOOPT, len; |
| 490 | int trans; |
| 491 | |
| 492 | if (level != SOL_RDS) |
| 493 | goto out; |
| 494 | |
| 495 | if (get_user(len, optlen)) { |
| 496 | ret = -EFAULT; |
| 497 | goto out; |
| 498 | } |
| 499 | |
| 500 | switch (optname) { |
| 501 | case RDS_INFO_FIRST ... RDS_INFO_LAST: |
| 502 | ret = rds_info_getsockopt(sock, optname, optval, |
| 503 | optlen); |
| 504 | break; |
| 505 | |
| 506 | case RDS_RECVERR: |
| 507 | if (len < sizeof(int)) |
| 508 | ret = -EINVAL; |
| 509 | else |
| 510 | if (put_user(rs->rs_recverr, (int __user *) optval) || |
| 511 | put_user(sizeof(int), optlen)) |
| 512 | ret = -EFAULT; |
| 513 | else |
| 514 | ret = 0; |
| 515 | break; |
| 516 | case SO_RDS_TRANSPORT: |
| 517 | if (len < sizeof(int)) { |
| 518 | ret = -EINVAL; |
| 519 | break; |
| 520 | } |
| 521 | trans = (rs->rs_transport ? rs->rs_transport->t_type : |
| 522 | RDS_TRANS_NONE); /* unbound */ |
| 523 | if (put_user(trans, (int __user *)optval) || |
| 524 | put_user(sizeof(int), optlen)) |
| 525 | ret = -EFAULT; |
| 526 | else |
| 527 | ret = 0; |
| 528 | break; |
| 529 | default: |
| 530 | break; |
| 531 | } |
| 532 | |
| 533 | out: |
| 534 | return ret; |
| 535 | |
| 536 | } |
| 537 | |
| 538 | static int rds_connect(struct socket *sock, struct sockaddr *uaddr, |
| 539 | int addr_len, int flags) |
| 540 | { |
| 541 | struct sock *sk = sock->sk; |
| 542 | struct sockaddr_in *sin; |
| 543 | struct rds_sock *rs = rds_sk_to_rs(sk); |
| 544 | int ret = 0; |
| 545 | |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 546 | if (addr_len < offsetofend(struct sockaddr, sa_family)) |
| 547 | return -EINVAL; |
| 548 | |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 549 | lock_sock(sk); |
| 550 | |
| 551 | switch (uaddr->sa_family) { |
| 552 | case AF_INET: |
| 553 | sin = (struct sockaddr_in *)uaddr; |
| 554 | if (addr_len < sizeof(struct sockaddr_in)) { |
| 555 | ret = -EINVAL; |
| 556 | break; |
| 557 | } |
| 558 | if (sin->sin_addr.s_addr == htonl(INADDR_ANY)) { |
| 559 | ret = -EDESTADDRREQ; |
| 560 | break; |
| 561 | } |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 562 | if (ipv4_is_multicast(sin->sin_addr.s_addr) || |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 563 | sin->sin_addr.s_addr == htonl(INADDR_BROADCAST)) { |
| 564 | ret = -EINVAL; |
| 565 | break; |
| 566 | } |
| 567 | ipv6_addr_set_v4mapped(sin->sin_addr.s_addr, &rs->rs_conn_addr); |
| 568 | rs->rs_conn_port = sin->sin_port; |
| 569 | break; |
| 570 | |
| 571 | #if IS_ENABLED(CONFIG_IPV6) |
| 572 | case AF_INET6: { |
| 573 | struct sockaddr_in6 *sin6; |
| 574 | int addr_type; |
| 575 | |
| 576 | sin6 = (struct sockaddr_in6 *)uaddr; |
| 577 | if (addr_len < sizeof(struct sockaddr_in6)) { |
| 578 | ret = -EINVAL; |
| 579 | break; |
| 580 | } |
| 581 | addr_type = ipv6_addr_type(&sin6->sin6_addr); |
| 582 | if (!(addr_type & IPV6_ADDR_UNICAST)) { |
| 583 | __be32 addr4; |
| 584 | |
| 585 | if (!(addr_type & IPV6_ADDR_MAPPED)) { |
| 586 | ret = -EPROTOTYPE; |
| 587 | break; |
| 588 | } |
| 589 | |
| 590 | /* It is a mapped address. Need to do some sanity |
| 591 | * checks. |
| 592 | */ |
| 593 | addr4 = sin6->sin6_addr.s6_addr32[3]; |
| 594 | if (addr4 == htonl(INADDR_ANY) || |
| 595 | addr4 == htonl(INADDR_BROADCAST) || |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 596 | ipv4_is_multicast(addr4)) { |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 597 | ret = -EPROTOTYPE; |
| 598 | break; |
| 599 | } |
| 600 | } |
| 601 | |
| 602 | if (addr_type & IPV6_ADDR_LINKLOCAL) { |
| 603 | /* If socket is arleady bound to a link local address, |
| 604 | * the peer address must be on the same link. |
| 605 | */ |
| 606 | if (sin6->sin6_scope_id == 0 || |
| 607 | (!ipv6_addr_any(&rs->rs_bound_addr) && |
| 608 | rs->rs_bound_scope_id && |
| 609 | sin6->sin6_scope_id != rs->rs_bound_scope_id)) { |
| 610 | ret = -EINVAL; |
| 611 | break; |
| 612 | } |
| 613 | /* Remember the connected address scope ID. It will |
| 614 | * be checked against the binding local address when |
| 615 | * the socket is bound. |
| 616 | */ |
| 617 | rs->rs_bound_scope_id = sin6->sin6_scope_id; |
| 618 | } |
| 619 | rs->rs_conn_addr = sin6->sin6_addr; |
| 620 | rs->rs_conn_port = sin6->sin6_port; |
| 621 | break; |
| 622 | } |
| 623 | #endif |
| 624 | |
| 625 | default: |
| 626 | ret = -EAFNOSUPPORT; |
| 627 | break; |
| 628 | } |
| 629 | |
| 630 | release_sock(sk); |
| 631 | return ret; |
| 632 | } |
| 633 | |
| 634 | static struct proto rds_proto = { |
| 635 | .name = "RDS", |
| 636 | .owner = THIS_MODULE, |
| 637 | .obj_size = sizeof(struct rds_sock), |
| 638 | }; |
| 639 | |
| 640 | static const struct proto_ops rds_proto_ops = { |
| 641 | .family = AF_RDS, |
| 642 | .owner = THIS_MODULE, |
| 643 | .release = rds_release, |
| 644 | .bind = rds_bind, |
| 645 | .connect = rds_connect, |
| 646 | .socketpair = sock_no_socketpair, |
| 647 | .accept = sock_no_accept, |
| 648 | .getname = rds_getname, |
| 649 | .poll = rds_poll, |
| 650 | .ioctl = rds_ioctl, |
| 651 | .listen = sock_no_listen, |
| 652 | .shutdown = sock_no_shutdown, |
| 653 | .setsockopt = rds_setsockopt, |
| 654 | .getsockopt = rds_getsockopt, |
| 655 | .sendmsg = rds_sendmsg, |
| 656 | .recvmsg = rds_recvmsg, |
| 657 | .mmap = sock_no_mmap, |
| 658 | .sendpage = sock_no_sendpage, |
| 659 | }; |
| 660 | |
| 661 | static void rds_sock_destruct(struct sock *sk) |
| 662 | { |
| 663 | struct rds_sock *rs = rds_sk_to_rs(sk); |
| 664 | |
| 665 | WARN_ON((&rs->rs_item != rs->rs_item.next || |
| 666 | &rs->rs_item != rs->rs_item.prev)); |
| 667 | } |
| 668 | |
| 669 | static int __rds_create(struct socket *sock, struct sock *sk, int protocol) |
| 670 | { |
| 671 | struct rds_sock *rs; |
| 672 | |
| 673 | sock_init_data(sock, sk); |
| 674 | sock->ops = &rds_proto_ops; |
| 675 | sk->sk_protocol = protocol; |
| 676 | sk->sk_destruct = rds_sock_destruct; |
| 677 | |
| 678 | rs = rds_sk_to_rs(sk); |
| 679 | spin_lock_init(&rs->rs_lock); |
| 680 | rwlock_init(&rs->rs_recv_lock); |
| 681 | INIT_LIST_HEAD(&rs->rs_send_queue); |
| 682 | INIT_LIST_HEAD(&rs->rs_recv_queue); |
| 683 | INIT_LIST_HEAD(&rs->rs_notify_queue); |
| 684 | INIT_LIST_HEAD(&rs->rs_cong_list); |
| 685 | rds_message_zcopy_queue_init(&rs->rs_zcookie_queue); |
| 686 | spin_lock_init(&rs->rs_rdma_lock); |
| 687 | rs->rs_rdma_keys = RB_ROOT; |
| 688 | rs->rs_rx_traces = 0; |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 689 | rs->rs_tos = 0; |
| 690 | rs->rs_conn = NULL; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 691 | |
| 692 | spin_lock_bh(&rds_sock_lock); |
| 693 | list_add_tail(&rs->rs_item, &rds_sock_list); |
| 694 | rds_sock_count++; |
| 695 | spin_unlock_bh(&rds_sock_lock); |
| 696 | |
| 697 | return 0; |
| 698 | } |
| 699 | |
| 700 | static int rds_create(struct net *net, struct socket *sock, int protocol, |
| 701 | int kern) |
| 702 | { |
| 703 | struct sock *sk; |
| 704 | |
| 705 | if (sock->type != SOCK_SEQPACKET || protocol) |
| 706 | return -ESOCKTNOSUPPORT; |
| 707 | |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 708 | sk = sk_alloc(net, AF_RDS, GFP_KERNEL, &rds_proto, kern); |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 709 | if (!sk) |
| 710 | return -ENOMEM; |
| 711 | |
| 712 | return __rds_create(sock, sk, protocol); |
| 713 | } |
| 714 | |
| 715 | void rds_sock_addref(struct rds_sock *rs) |
| 716 | { |
| 717 | sock_hold(rds_rs_to_sk(rs)); |
| 718 | } |
| 719 | |
| 720 | void rds_sock_put(struct rds_sock *rs) |
| 721 | { |
| 722 | sock_put(rds_rs_to_sk(rs)); |
| 723 | } |
| 724 | |
| 725 | static const struct net_proto_family rds_family_ops = { |
| 726 | .family = AF_RDS, |
| 727 | .create = rds_create, |
| 728 | .owner = THIS_MODULE, |
| 729 | }; |
| 730 | |
| 731 | static void rds_sock_inc_info(struct socket *sock, unsigned int len, |
| 732 | struct rds_info_iterator *iter, |
| 733 | struct rds_info_lengths *lens) |
| 734 | { |
| 735 | struct rds_sock *rs; |
| 736 | struct rds_incoming *inc; |
| 737 | unsigned int total = 0; |
| 738 | |
| 739 | len /= sizeof(struct rds_info_message); |
| 740 | |
| 741 | spin_lock_bh(&rds_sock_lock); |
| 742 | |
| 743 | list_for_each_entry(rs, &rds_sock_list, rs_item) { |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 744 | /* This option only supports IPv4 sockets. */ |
| 745 | if (!ipv6_addr_v4mapped(&rs->rs_bound_addr)) |
| 746 | continue; |
| 747 | |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 748 | read_lock(&rs->rs_recv_lock); |
| 749 | |
| 750 | /* XXX too lazy to maintain counts.. */ |
| 751 | list_for_each_entry(inc, &rs->rs_recv_queue, i_item) { |
| 752 | total++; |
| 753 | if (total <= len) |
| 754 | rds_inc_info_copy(inc, iter, |
| 755 | inc->i_saddr.s6_addr32[3], |
| 756 | rs->rs_bound_addr_v4, |
| 757 | 1); |
| 758 | } |
| 759 | |
| 760 | read_unlock(&rs->rs_recv_lock); |
| 761 | } |
| 762 | |
| 763 | spin_unlock_bh(&rds_sock_lock); |
| 764 | |
| 765 | lens->nr = total; |
| 766 | lens->each = sizeof(struct rds_info_message); |
| 767 | } |
| 768 | |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 769 | #if IS_ENABLED(CONFIG_IPV6) |
| 770 | static void rds6_sock_inc_info(struct socket *sock, unsigned int len, |
| 771 | struct rds_info_iterator *iter, |
| 772 | struct rds_info_lengths *lens) |
| 773 | { |
| 774 | struct rds_incoming *inc; |
| 775 | unsigned int total = 0; |
| 776 | struct rds_sock *rs; |
| 777 | |
| 778 | len /= sizeof(struct rds6_info_message); |
| 779 | |
| 780 | spin_lock_bh(&rds_sock_lock); |
| 781 | |
| 782 | list_for_each_entry(rs, &rds_sock_list, rs_item) { |
| 783 | read_lock(&rs->rs_recv_lock); |
| 784 | |
| 785 | list_for_each_entry(inc, &rs->rs_recv_queue, i_item) { |
| 786 | total++; |
| 787 | if (total <= len) |
| 788 | rds6_inc_info_copy(inc, iter, &inc->i_saddr, |
| 789 | &rs->rs_bound_addr, 1); |
| 790 | } |
| 791 | |
| 792 | read_unlock(&rs->rs_recv_lock); |
| 793 | } |
| 794 | |
| 795 | spin_unlock_bh(&rds_sock_lock); |
| 796 | |
| 797 | lens->nr = total; |
| 798 | lens->each = sizeof(struct rds6_info_message); |
| 799 | } |
| 800 | #endif |
| 801 | |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 802 | static void rds_sock_info(struct socket *sock, unsigned int len, |
| 803 | struct rds_info_iterator *iter, |
| 804 | struct rds_info_lengths *lens) |
| 805 | { |
| 806 | struct rds_info_socket sinfo; |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 807 | unsigned int cnt = 0; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 808 | struct rds_sock *rs; |
| 809 | |
| 810 | len /= sizeof(struct rds_info_socket); |
| 811 | |
| 812 | spin_lock_bh(&rds_sock_lock); |
| 813 | |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 814 | if (len < rds_sock_count) { |
| 815 | cnt = rds_sock_count; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 816 | goto out; |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 817 | } |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 818 | |
| 819 | list_for_each_entry(rs, &rds_sock_list, rs_item) { |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 820 | /* This option only supports IPv4 sockets. */ |
| 821 | if (!ipv6_addr_v4mapped(&rs->rs_bound_addr)) |
| 822 | continue; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 823 | sinfo.sndbuf = rds_sk_sndbuf(rs); |
| 824 | sinfo.rcvbuf = rds_sk_rcvbuf(rs); |
| 825 | sinfo.bound_addr = rs->rs_bound_addr_v4; |
| 826 | sinfo.connected_addr = rs->rs_conn_addr_v4; |
| 827 | sinfo.bound_port = rs->rs_bound_port; |
| 828 | sinfo.connected_port = rs->rs_conn_port; |
| 829 | sinfo.inum = sock_i_ino(rds_rs_to_sk(rs)); |
| 830 | |
| 831 | rds_info_copy(iter, &sinfo, sizeof(sinfo)); |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 832 | cnt++; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 833 | } |
| 834 | |
| 835 | out: |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 836 | lens->nr = cnt; |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 837 | lens->each = sizeof(struct rds_info_socket); |
| 838 | |
| 839 | spin_unlock_bh(&rds_sock_lock); |
| 840 | } |
| 841 | |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 842 | #if IS_ENABLED(CONFIG_IPV6) |
| 843 | static void rds6_sock_info(struct socket *sock, unsigned int len, |
| 844 | struct rds_info_iterator *iter, |
| 845 | struct rds_info_lengths *lens) |
| 846 | { |
| 847 | struct rds6_info_socket sinfo6; |
| 848 | struct rds_sock *rs; |
| 849 | |
| 850 | len /= sizeof(struct rds6_info_socket); |
| 851 | |
| 852 | spin_lock_bh(&rds_sock_lock); |
| 853 | |
| 854 | if (len < rds_sock_count) |
| 855 | goto out; |
| 856 | |
| 857 | list_for_each_entry(rs, &rds_sock_list, rs_item) { |
| 858 | sinfo6.sndbuf = rds_sk_sndbuf(rs); |
| 859 | sinfo6.rcvbuf = rds_sk_rcvbuf(rs); |
| 860 | sinfo6.bound_addr = rs->rs_bound_addr; |
| 861 | sinfo6.connected_addr = rs->rs_conn_addr; |
| 862 | sinfo6.bound_port = rs->rs_bound_port; |
| 863 | sinfo6.connected_port = rs->rs_conn_port; |
| 864 | sinfo6.inum = sock_i_ino(rds_rs_to_sk(rs)); |
| 865 | |
| 866 | rds_info_copy(iter, &sinfo6, sizeof(sinfo6)); |
| 867 | } |
| 868 | |
| 869 | out: |
| 870 | lens->nr = rds_sock_count; |
| 871 | lens->each = sizeof(struct rds6_info_socket); |
| 872 | |
| 873 | spin_unlock_bh(&rds_sock_lock); |
| 874 | } |
| 875 | #endif |
| 876 | |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 877 | static void rds_exit(void) |
| 878 | { |
| 879 | sock_unregister(rds_family_ops.family); |
| 880 | proto_unregister(&rds_proto); |
| 881 | rds_conn_exit(); |
| 882 | rds_cong_exit(); |
| 883 | rds_sysctl_exit(); |
| 884 | rds_threads_exit(); |
| 885 | rds_stats_exit(); |
| 886 | rds_page_exit(); |
| 887 | rds_bind_lock_destroy(); |
| 888 | rds_info_deregister_func(RDS_INFO_SOCKETS, rds_sock_info); |
| 889 | rds_info_deregister_func(RDS_INFO_RECV_MESSAGES, rds_sock_inc_info); |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 890 | #if IS_ENABLED(CONFIG_IPV6) |
| 891 | rds_info_deregister_func(RDS6_INFO_SOCKETS, rds6_sock_info); |
| 892 | rds_info_deregister_func(RDS6_INFO_RECV_MESSAGES, rds6_sock_inc_info); |
| 893 | #endif |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 894 | } |
| 895 | module_exit(rds_exit); |
| 896 | |
| 897 | u32 rds_gen_num; |
| 898 | |
| 899 | static int rds_init(void) |
| 900 | { |
| 901 | int ret; |
| 902 | |
| 903 | net_get_random_once(&rds_gen_num, sizeof(rds_gen_num)); |
| 904 | |
| 905 | ret = rds_bind_lock_init(); |
| 906 | if (ret) |
| 907 | goto out; |
| 908 | |
| 909 | ret = rds_conn_init(); |
| 910 | if (ret) |
| 911 | goto out_bind; |
| 912 | |
| 913 | ret = rds_threads_init(); |
| 914 | if (ret) |
| 915 | goto out_conn; |
| 916 | ret = rds_sysctl_init(); |
| 917 | if (ret) |
| 918 | goto out_threads; |
| 919 | ret = rds_stats_init(); |
| 920 | if (ret) |
| 921 | goto out_sysctl; |
| 922 | ret = proto_register(&rds_proto, 1); |
| 923 | if (ret) |
| 924 | goto out_stats; |
| 925 | ret = sock_register(&rds_family_ops); |
| 926 | if (ret) |
| 927 | goto out_proto; |
| 928 | |
| 929 | rds_info_register_func(RDS_INFO_SOCKETS, rds_sock_info); |
| 930 | rds_info_register_func(RDS_INFO_RECV_MESSAGES, rds_sock_inc_info); |
David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame] | 931 | #if IS_ENABLED(CONFIG_IPV6) |
| 932 | rds_info_register_func(RDS6_INFO_SOCKETS, rds6_sock_info); |
| 933 | rds_info_register_func(RDS6_INFO_RECV_MESSAGES, rds6_sock_inc_info); |
| 934 | #endif |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 935 | |
| 936 | goto out; |
| 937 | |
| 938 | out_proto: |
| 939 | proto_unregister(&rds_proto); |
| 940 | out_stats: |
| 941 | rds_stats_exit(); |
| 942 | out_sysctl: |
| 943 | rds_sysctl_exit(); |
| 944 | out_threads: |
| 945 | rds_threads_exit(); |
| 946 | out_conn: |
| 947 | rds_conn_exit(); |
| 948 | rds_cong_exit(); |
| 949 | rds_page_exit(); |
| 950 | out_bind: |
| 951 | rds_bind_lock_destroy(); |
| 952 | out: |
| 953 | return ret; |
| 954 | } |
| 955 | module_init(rds_init); |
| 956 | |
| 957 | #define DRV_VERSION "4.0" |
| 958 | #define DRV_RELDATE "Feb 12, 2009" |
| 959 | |
| 960 | MODULE_AUTHOR("Oracle Corporation <rds-devel@oss.oracle.com>"); |
| 961 | MODULE_DESCRIPTION("RDS: Reliable Datagram Sockets" |
| 962 | " v" DRV_VERSION " (" DRV_RELDATE ")"); |
| 963 | MODULE_VERSION(DRV_VERSION); |
| 964 | MODULE_LICENSE("Dual BSD/GPL"); |
| 965 | MODULE_ALIAS_NETPROTO(PF_RDS); |