blob: 7212de4da71db8ccf37b09b994115da8d4bab253 [file] [log] [blame]
Thomas Gleixner09c434b2019-05-19 13:08:20 +01001// SPDX-License-Identifier: GPL-2.0-only
Ursula Braunac713872017-01-09 16:55:13 +01002/*
3 * Shared Memory Communications over RDMA (SMC-R) and RoCE
4 *
5 * AF_SMC protocol family socket handler keeping the AF_INET sock address type
6 * applies to SOCK_STREAM sockets only
7 * offers an alternative communication option for TCP-protocol sockets
8 * applicable with RoCE-cards only
9 *
Ursula Brauna046d572017-01-09 16:55:16 +010010 * Initial restrictions:
Ursula Brauna046d572017-01-09 16:55:16 +010011 * - support for alternate links postponed
Ursula Brauna046d572017-01-09 16:55:16 +010012 *
Karsten Graulaaa4d332018-03-16 15:06:41 +010013 * Copyright IBM Corp. 2016, 2018
Ursula Braunac713872017-01-09 16:55:13 +010014 *
15 * Author(s): Ursula Braun <ubraun@linux.vnet.ibm.com>
16 * based on prototype from Frank Blaschka
17 */
18
19#define KMSG_COMPONENT "smc"
20#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
21
22#include <linux/module.h>
23#include <linux/socket.h>
Ursula Brauna046d572017-01-09 16:55:16 +010024#include <linux/workqueue.h>
Ursula Braun5f083182017-01-09 16:55:22 +010025#include <linux/in.h>
Ingo Molnarc3edc402017-02-02 08:35:14 +010026#include <linux/sched/signal.h>
Hans Wippel41349842018-06-28 19:05:11 +020027#include <linux/if_vlan.h>
Ursula Braun4ead9c92019-11-16 17:47:31 +010028#include <linux/rcupdate_wait.h>
Ingo Molnarc3edc402017-02-02 08:35:14 +010029
Ursula Braunac713872017-01-09 16:55:13 +010030#include <net/sock.h>
Ursula Brauna046d572017-01-09 16:55:16 +010031#include <net/tcp.h>
Ursula Braunf16a7dd2017-01-09 16:55:26 +010032#include <net/smc.h>
Ursula Braun9b67e262018-05-02 16:56:46 +020033#include <asm/ioctls.h>
Ursula Braunac713872017-01-09 16:55:13 +010034
Hans Wippel64e28b52019-02-21 13:01:02 +010035#include <net/net_namespace.h>
36#include <net/netns/generic.h>
37#include "smc_netns.h"
38
Ursula Braunac713872017-01-09 16:55:13 +010039#include "smc.h"
Ursula Brauna046d572017-01-09 16:55:16 +010040#include "smc_clc.h"
Ursula Braun9bf9abe2017-01-09 16:55:21 +010041#include "smc_llc.h"
Ursula Braun5f083182017-01-09 16:55:22 +010042#include "smc_cdc.h"
Ursula Braun0cfdd8f2017-01-09 16:55:17 +010043#include "smc_core.h"
Ursula Brauna4cf0442017-01-09 16:55:14 +010044#include "smc_ib.h"
Hans Wippel41349842018-06-28 19:05:11 +020045#include "smc_ism.h"
Thomas Richter6812baa2017-01-09 16:55:15 +010046#include "smc_pnet.h"
Ursula Braune6727f32017-01-09 16:55:23 +010047#include "smc_tx.h"
Ursula Braun952310c2017-01-09 16:55:24 +010048#include "smc_rx.h"
Ursula Braunb38d7322017-01-09 16:55:25 +010049#include "smc_close.h"
Ursula Braunac713872017-01-09 16:55:13 +010050
Hans Wippel72a36a82019-02-07 15:56:18 +010051static DEFINE_MUTEX(smc_server_lgr_pending); /* serialize link group
52 * creation on server
53 */
54static DEFINE_MUTEX(smc_client_lgr_pending); /* serialize link group
55 * creation on client
Ursula Braun0cfdd8f2017-01-09 16:55:17 +010056 */
57
Ursula Brauna046d572017-01-09 16:55:16 +010058static void smc_tcp_listen_work(struct work_struct *);
Ursula Braun24ac3a02018-06-27 17:59:50 +020059static void smc_connect_work(struct work_struct *);
Ursula Brauna046d572017-01-09 16:55:16 +010060
Ursula Braunac713872017-01-09 16:55:13 +010061static void smc_set_keepalive(struct sock *sk, int val)
62{
63 struct smc_sock *smc = smc_sk(sk);
64
65 smc->clcsock->sk->sk_prot->keepalive(smc->clcsock->sk, val);
66}
67
Ursula Braunf16a7dd2017-01-09 16:55:26 +010068static struct smc_hashinfo smc_v4_hashinfo = {
69 .lock = __RW_LOCK_UNLOCKED(smc_v4_hashinfo.lock),
70};
71
Karsten Graulaaa4d332018-03-16 15:06:41 +010072static struct smc_hashinfo smc_v6_hashinfo = {
73 .lock = __RW_LOCK_UNLOCKED(smc_v6_hashinfo.lock),
74};
75
Ursula Braunf16a7dd2017-01-09 16:55:26 +010076int smc_hash_sk(struct sock *sk)
77{
78 struct smc_hashinfo *h = sk->sk_prot->h.smc_hash;
79 struct hlist_head *head;
80
81 head = &h->ht;
82
83 write_lock_bh(&h->lock);
84 sk_add_node(sk, head);
85 sock_prot_inuse_add(sock_net(sk), sk->sk_prot, 1);
86 write_unlock_bh(&h->lock);
87
88 return 0;
89}
90EXPORT_SYMBOL_GPL(smc_hash_sk);
91
92void smc_unhash_sk(struct sock *sk)
93{
94 struct smc_hashinfo *h = sk->sk_prot->h.smc_hash;
95
96 write_lock_bh(&h->lock);
97 if (sk_del_node_init(sk))
98 sock_prot_inuse_add(sock_net(sk), sk->sk_prot, -1);
99 write_unlock_bh(&h->lock);
100}
101EXPORT_SYMBOL_GPL(smc_unhash_sk);
102
103struct proto smc_proto = {
Ursula Braunac713872017-01-09 16:55:13 +0100104 .name = "SMC",
105 .owner = THIS_MODULE,
106 .keepalive = smc_set_keepalive,
Ursula Braunf16a7dd2017-01-09 16:55:26 +0100107 .hash = smc_hash_sk,
108 .unhash = smc_unhash_sk,
Ursula Braunac713872017-01-09 16:55:13 +0100109 .obj_size = sizeof(struct smc_sock),
Ursula Braunf16a7dd2017-01-09 16:55:26 +0100110 .h.smc_hash = &smc_v4_hashinfo,
Paul E. McKenney5f0d5a32017-01-18 02:53:44 -0800111 .slab_flags = SLAB_TYPESAFE_BY_RCU,
Ursula Braunac713872017-01-09 16:55:13 +0100112};
Ursula Braunf16a7dd2017-01-09 16:55:26 +0100113EXPORT_SYMBOL_GPL(smc_proto);
Ursula Braunac713872017-01-09 16:55:13 +0100114
Karsten Graulaaa4d332018-03-16 15:06:41 +0100115struct proto smc_proto6 = {
116 .name = "SMC6",
117 .owner = THIS_MODULE,
118 .keepalive = smc_set_keepalive,
119 .hash = smc_hash_sk,
120 .unhash = smc_unhash_sk,
121 .obj_size = sizeof(struct smc_sock),
122 .h.smc_hash = &smc_v6_hashinfo,
123 .slab_flags = SLAB_TYPESAFE_BY_RCU,
124};
125EXPORT_SYMBOL_GPL(smc_proto6);
126
Ursula Braunf536dff2019-10-23 15:44:05 +0200127static void smc_restore_fallback_changes(struct smc_sock *smc)
128{
Karsten Graul1ad24052020-07-18 15:06:18 +0200129 if (smc->clcsock->file) { /* non-accepted sockets have no file yet */
130 smc->clcsock->file->private_data = smc->sk.sk_socket;
131 smc->clcsock->file = NULL;
132 }
Ursula Braunf536dff2019-10-23 15:44:05 +0200133}
134
Ursula Braun39f41f32019-06-27 15:04:52 +0200135static int __smc_release(struct smc_sock *smc)
Ursula Braunac713872017-01-09 16:55:13 +0100136{
Ursula Braun39f41f32019-06-27 15:04:52 +0200137 struct sock *sk = &smc->sk;
Ursula Braunb38d7322017-01-09 16:55:25 +0100138 int rc = 0;
Ursula Braunac713872017-01-09 16:55:13 +0100139
Ursula Braun51f1de72018-01-26 09:28:48 +0100140 if (!smc->use_fallback) {
Ursula Braunb38d7322017-01-09 16:55:25 +0100141 rc = smc_close_active(smc);
142 sock_set_flag(sk, SOCK_DEAD);
143 sk->sk_shutdown |= SHUTDOWN_MASK;
Ursula Braunb03faa12019-02-07 15:56:15 +0100144 } else {
145 if (sk->sk_state != SMC_LISTEN && sk->sk_state != SMC_INIT)
146 sock_put(sk); /* passive closing */
147 if (sk->sk_state == SMC_LISTEN) {
148 /* wake up clcsock accept */
149 rc = kernel_sock_shutdown(smc->clcsock, SHUT_RDWR);
150 }
151 sk->sk_state = SMC_CLOSED;
152 sk->sk_state_change(sk);
Ursula Braunf536dff2019-10-23 15:44:05 +0200153 smc_restore_fallback_changes(smc);
Ursula Braunb38d7322017-01-09 16:55:25 +0100154 }
Cong Wang26d92e92019-01-05 23:45:26 -0800155
156 sk->sk_prot->unhash(sk);
157
Ursula Braunb03faa12019-02-07 15:56:15 +0100158 if (sk->sk_state == SMC_CLOSED) {
159 if (smc->clcsock) {
Karsten Graulfd577702019-04-11 11:17:30 +0200160 release_sock(sk);
161 smc_clcsock_release(smc);
162 lock_sock(sk);
Myungho Jung78abe3d2018-12-18 09:02:25 -0800163 }
Ursula Braunb03faa12019-02-07 15:56:15 +0100164 if (!smc->use_fallback)
165 smc_conn_free(&smc->conn);
Ursula Braun51f1de72018-01-26 09:28:48 +0100166 }
Ursula Braunac713872017-01-09 16:55:13 +0100167
Ursula Braun39f41f32019-06-27 15:04:52 +0200168 return rc;
169}
170
171static int smc_release(struct socket *sock)
172{
173 struct sock *sk = sock->sk;
174 struct smc_sock *smc;
175 int rc = 0;
176
177 if (!sk)
178 goto out;
179
Ursula Braun81cf4f42019-10-21 16:13:15 +0200180 sock_hold(sk); /* sock_put below */
Ursula Braun39f41f32019-06-27 15:04:52 +0200181 smc = smc_sk(sk);
182
183 /* cleanup for a dangling non-blocking connect */
184 if (smc->connect_nonblock && sk->sk_state == SMC_INIT)
185 tcp_abort(smc->clcsock->sk, ECONNABORTED);
186 flush_work(&smc->connect_work);
187
188 if (sk->sk_state == SMC_LISTEN)
189 /* smc_close_non_accepted() is called and acquires
190 * sock lock for child sockets again
191 */
192 lock_sock_nested(sk, SINGLE_DEPTH_NESTING);
193 else
194 lock_sock(sk);
195
196 rc = __smc_release(smc);
197
Ursula Braunac713872017-01-09 16:55:13 +0100198 /* detach socket */
199 sock_orphan(sk);
200 sock->sk = NULL;
201 release_sock(sk);
202
Ursula Braun81cf4f42019-10-21 16:13:15 +0200203 sock_put(sk); /* sock_hold above */
Ursula Braun51f1de72018-01-26 09:28:48 +0100204 sock_put(sk); /* final sock_put */
Ursula Braunac713872017-01-09 16:55:13 +0100205out:
Ursula Braunb38d7322017-01-09 16:55:25 +0100206 return rc;
Ursula Braunac713872017-01-09 16:55:13 +0100207}
208
209static void smc_destruct(struct sock *sk)
210{
211 if (sk->sk_state != SMC_CLOSED)
212 return;
213 if (!sock_flag(sk, SOCK_DEAD))
214 return;
215
216 sk_refcnt_debug_dec(sk);
217}
218
Karsten Graulaaa4d332018-03-16 15:06:41 +0100219static struct sock *smc_sock_alloc(struct net *net, struct socket *sock,
220 int protocol)
Ursula Braunac713872017-01-09 16:55:13 +0100221{
222 struct smc_sock *smc;
Karsten Graulaaa4d332018-03-16 15:06:41 +0100223 struct proto *prot;
Ursula Braunac713872017-01-09 16:55:13 +0100224 struct sock *sk;
225
Karsten Graulaaa4d332018-03-16 15:06:41 +0100226 prot = (protocol == SMCPROTO_SMC6) ? &smc_proto6 : &smc_proto;
227 sk = sk_alloc(net, PF_SMC, GFP_KERNEL, prot, 0);
Ursula Braunac713872017-01-09 16:55:13 +0100228 if (!sk)
229 return NULL;
230
231 sock_init_data(sock, sk); /* sets sk_refcnt to 1 */
232 sk->sk_state = SMC_INIT;
233 sk->sk_destruct = smc_destruct;
Karsten Graulaaa4d332018-03-16 15:06:41 +0100234 sk->sk_protocol = protocol;
Ursula Braunac713872017-01-09 16:55:13 +0100235 smc = smc_sk(sk);
Ursula Brauna046d572017-01-09 16:55:16 +0100236 INIT_WORK(&smc->tcp_listen_work, smc_tcp_listen_work);
Ursula Braun24ac3a02018-06-27 17:59:50 +0200237 INIT_WORK(&smc->connect_work, smc_connect_work);
Eric Dumazetbe7f3e52018-05-17 03:54:21 -0700238 INIT_DELAYED_WORK(&smc->conn.tx_work, smc_tx_work);
Ursula Brauna046d572017-01-09 16:55:16 +0100239 INIT_LIST_HEAD(&smc->accept_q);
240 spin_lock_init(&smc->accept_q_lock);
Eric Dumazetbe7f3e52018-05-17 03:54:21 -0700241 spin_lock_init(&smc->conn.send_lock);
Ursula Braunf16a7dd2017-01-09 16:55:26 +0100242 sk->sk_prot->hash(sk);
Ursula Brauna046d572017-01-09 16:55:16 +0100243 sk_refcnt_debug_inc(sk);
Myungho Jung78abe3d2018-12-18 09:02:25 -0800244 mutex_init(&smc->clcsock_release_lock);
Ursula Braunac713872017-01-09 16:55:13 +0100245
246 return sk;
247}
248
249static int smc_bind(struct socket *sock, struct sockaddr *uaddr,
250 int addr_len)
251{
252 struct sockaddr_in *addr = (struct sockaddr_in *)uaddr;
253 struct sock *sk = sock->sk;
254 struct smc_sock *smc;
255 int rc;
256
257 smc = smc_sk(sk);
258
259 /* replicate tests from inet_bind(), to be safe wrt. future changes */
260 rc = -EINVAL;
261 if (addr_len < sizeof(struct sockaddr_in))
262 goto out;
263
264 rc = -EAFNOSUPPORT;
Karsten Graulaaa4d332018-03-16 15:06:41 +0100265 if (addr->sin_family != AF_INET &&
266 addr->sin_family != AF_INET6 &&
267 addr->sin_family != AF_UNSPEC)
268 goto out;
Ursula Braunac713872017-01-09 16:55:13 +0100269 /* accept AF_UNSPEC (mapped to AF_INET) only if s_addr is INADDR_ANY */
Karsten Graulaaa4d332018-03-16 15:06:41 +0100270 if (addr->sin_family == AF_UNSPEC &&
271 addr->sin_addr.s_addr != htonl(INADDR_ANY))
Ursula Braunac713872017-01-09 16:55:13 +0100272 goto out;
273
274 lock_sock(sk);
275
276 /* Check if socket is already active */
277 rc = -EINVAL;
Ursula Brauncd206362019-08-02 10:47:50 +0200278 if (sk->sk_state != SMC_INIT || smc->connect_nonblock)
Ursula Braunac713872017-01-09 16:55:13 +0100279 goto out_rel;
280
281 smc->clcsock->sk->sk_reuse = sk->sk_reuse;
282 rc = kernel_bind(smc->clcsock, uaddr, addr_len);
283
284out_rel:
285 release_sock(sk);
286out:
287 return rc;
288}
289
290static void smc_copy_sock_settings(struct sock *nsk, struct sock *osk,
291 unsigned long mask)
292{
293 /* options we don't get control via setsockopt for */
294 nsk->sk_type = osk->sk_type;
295 nsk->sk_sndbuf = osk->sk_sndbuf;
296 nsk->sk_rcvbuf = osk->sk_rcvbuf;
297 nsk->sk_sndtimeo = osk->sk_sndtimeo;
298 nsk->sk_rcvtimeo = osk->sk_rcvtimeo;
299 nsk->sk_mark = osk->sk_mark;
300 nsk->sk_priority = osk->sk_priority;
301 nsk->sk_rcvlowat = osk->sk_rcvlowat;
302 nsk->sk_bound_dev_if = osk->sk_bound_dev_if;
303 nsk->sk_err = osk->sk_err;
304
305 nsk->sk_flags &= ~mask;
306 nsk->sk_flags |= osk->sk_flags & mask;
307}
308
309#define SK_FLAGS_SMC_TO_CLC ((1UL << SOCK_URGINLINE) | \
310 (1UL << SOCK_KEEPOPEN) | \
311 (1UL << SOCK_LINGER) | \
312 (1UL << SOCK_BROADCAST) | \
313 (1UL << SOCK_TIMESTAMP) | \
314 (1UL << SOCK_DBG) | \
315 (1UL << SOCK_RCVTSTAMP) | \
316 (1UL << SOCK_RCVTSTAMPNS) | \
317 (1UL << SOCK_LOCALROUTE) | \
318 (1UL << SOCK_TIMESTAMPING_RX_SOFTWARE) | \
319 (1UL << SOCK_RXQ_OVFL) | \
320 (1UL << SOCK_WIFI_STATUS) | \
321 (1UL << SOCK_NOFCS) | \
Deepa Dinamani97184752019-02-02 07:34:51 -0800322 (1UL << SOCK_FILTER_LOCKED) | \
323 (1UL << SOCK_TSTAMP_NEW))
Ursula Braunac713872017-01-09 16:55:13 +0100324/* copy only relevant settings and flags of SOL_SOCKET level from smc to
325 * clc socket (since smc is not called for these options from net/core)
326 */
327static void smc_copy_sock_settings_to_clc(struct smc_sock *smc)
328{
329 smc_copy_sock_settings(smc->clcsock->sk, &smc->sk, SK_FLAGS_SMC_TO_CLC);
330}
331
332#define SK_FLAGS_CLC_TO_SMC ((1UL << SOCK_URGINLINE) | \
333 (1UL << SOCK_KEEPOPEN) | \
334 (1UL << SOCK_LINGER) | \
335 (1UL << SOCK_DBG))
336/* copy only settings and flags relevant for smc from clc to smc socket */
337static void smc_copy_sock_settings_to_smc(struct smc_sock *smc)
338{
339 smc_copy_sock_settings(&smc->sk, smc->clcsock->sk, SK_FLAGS_CLC_TO_SMC);
340}
341
Karsten Graulb9247542020-04-29 17:10:41 +0200342/* register the new rmb on all links */
Karsten Graul7562a132020-05-01 12:48:01 +0200343static int smcr_lgr_reg_rmbs(struct smc_link *link,
Karsten Graulb9247542020-04-29 17:10:41 +0200344 struct smc_buf_desc *rmb_desc)
345{
Karsten Graul7562a132020-05-01 12:48:01 +0200346 struct smc_link_group *lgr = link->lgr;
347 int i, rc = 0;
Karsten Graulb9247542020-04-29 17:10:41 +0200348
Karsten Grauld5500662020-05-01 12:48:05 +0200349 rc = smc_llc_flow_initiate(lgr, SMC_LLC_FLOW_RKEY);
350 if (rc)
351 return rc;
352 /* protect against parallel smc_llc_cli_rkey_exchange() and
353 * parallel smcr_link_reg_rmb()
354 */
355 mutex_lock(&lgr->llc_conf_mutex);
Karsten Graulb9247542020-04-29 17:10:41 +0200356 for (i = 0; i < SMC_LINKS_PER_LGR_MAX; i++) {
Karsten Graul741a49a2020-07-18 15:06:16 +0200357 if (!smc_link_active(&lgr->lnk[i]))
Karsten Graulb9247542020-04-29 17:10:41 +0200358 continue;
Karsten Graul7562a132020-05-01 12:48:01 +0200359 rc = smcr_link_reg_rmb(&lgr->lnk[i], rmb_desc);
Karsten Graulb9247542020-04-29 17:10:41 +0200360 if (rc)
Karsten Graul7562a132020-05-01 12:48:01 +0200361 goto out;
Karsten Graulb9247542020-04-29 17:10:41 +0200362 }
Karsten Graul7562a132020-05-01 12:48:01 +0200363
364 /* exchange confirm_rkey msg with peer */
365 rc = smc_llc_do_confirm_rkey(link, rmb_desc);
366 if (rc) {
367 rc = -EFAULT;
368 goto out;
369 }
370 rmb_desc->is_conf_rkey = true;
371out:
Karsten Grauld5500662020-05-01 12:48:05 +0200372 mutex_unlock(&lgr->llc_conf_mutex);
373 smc_llc_flow_stop(lgr, &lgr->llc_flow_lcl);
Karsten Graul7562a132020-05-01 12:48:01 +0200374 return rc;
Karsten Graulb9247542020-04-29 17:10:41 +0200375}
376
377static int smcr_clnt_conf_first_link(struct smc_sock *smc)
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100378{
Karsten Graul387707f2020-04-29 17:10:40 +0200379 struct smc_link *link = smc->conn.lnk;
Karsten Graul0fb0b022020-04-30 15:55:43 +0200380 struct smc_llc_qentry *qentry;
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100381 int rc;
382
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100383 /* receive CONFIRM LINK request from server over RoCE fabric */
Karsten Graul0fb0b022020-04-30 15:55:43 +0200384 qentry = smc_llc_wait(link->lgr, NULL, SMC_LLC_WAIT_TIME,
385 SMC_LLC_CONFIRM_LINK);
386 if (!qentry) {
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100387 struct smc_clc_msg_decline dclc;
388
389 rc = smc_clc_wait_msg(smc, &dclc, sizeof(dclc),
Ursula Braun2b59f582018-11-22 10:26:39 +0100390 SMC_CLC_DECLINE, CLC_WAIT_TIME_SHORT);
Ursula Braun9ed28552018-11-22 10:26:37 +0100391 return rc == -EAGAIN ? SMC_CLC_DECL_TIMEOUT_CL : rc;
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100392 }
Karsten Graul649758f2020-05-04 14:18:48 +0200393 smc_llc_save_peer_uid(qentry);
Karsten Graul0fb0b022020-04-30 15:55:43 +0200394 rc = smc_llc_eval_conf_link(qentry, SMC_LLC_REQ);
395 smc_llc_flow_qentry_del(&link->lgr->llc_flow_lcl);
396 if (rc)
Karsten Graul75d320d2018-03-01 13:51:31 +0100397 return SMC_CLC_DECL_RMBE_EC;
398
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100399 rc = smc_ib_modify_qp_rts(link);
400 if (rc)
Karsten Graul603cc142018-07-25 16:35:32 +0200401 return SMC_CLC_DECL_ERR_RDYLNK;
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100402
403 smc_wr_remember_qp_attr(link);
Ursula Braun652a1e42017-07-28 13:56:17 +0200404
Karsten Graul7562a132020-05-01 12:48:01 +0200405 if (smcr_link_reg_rmb(link, smc->conn.rmb_desc))
Karsten Graul603cc142018-07-25 16:35:32 +0200406 return SMC_CLC_DECL_ERR_REGRMB;
Ursula Braun652a1e42017-07-28 13:56:17 +0200407
Karsten Graul0fb0b022020-04-30 15:55:43 +0200408 /* confirm_rkey is implicit on 1st contact */
409 smc->conn.rmb_desc->is_conf_rkey = true;
410
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100411 /* send CONFIRM LINK response over RoCE fabric */
Ursula Braun947541f2018-07-25 16:35:30 +0200412 rc = smc_llc_send_confirm_link(link, SMC_LLC_RESP);
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100413 if (rc < 0)
Karsten Graul603cc142018-07-25 16:35:32 +0200414 return SMC_CLC_DECL_TIMEOUT_CL;
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100415
Karsten Graul0fb0b022020-04-30 15:55:43 +0200416 smc_llc_link_active(link);
Karsten Graul0a99be42020-05-05 15:01:20 +0200417 smcr_lgr_set_type(link->lgr, SMC_LGR_SINGLE);
Karsten Graul0fb0b022020-04-30 15:55:43 +0200418
419 /* optional 2nd link, receive ADD LINK request from server */
420 qentry = smc_llc_wait(link->lgr, NULL, SMC_LLC_WAIT_TIME,
421 SMC_LLC_ADD_LINK);
422 if (!qentry) {
Karsten Graul52bedf32018-03-01 13:51:32 +0100423 struct smc_clc_msg_decline dclc;
424
425 rc = smc_clc_wait_msg(smc, &dclc, sizeof(dclc),
Ursula Braun2b59f582018-11-22 10:26:39 +0100426 SMC_CLC_DECLINE, CLC_WAIT_TIME_SHORT);
Karsten Graul0fb0b022020-04-30 15:55:43 +0200427 if (rc == -EAGAIN)
428 rc = 0; /* no DECLINE received, go with one link */
429 return rc;
Karsten Graul52bedf32018-03-01 13:51:32 +0100430 }
Karsten Graul0fb0b022020-04-30 15:55:43 +0200431 smc_llc_flow_qentry_clr(&link->lgr->llc_flow_lcl);
Karsten Graulb1570a82020-05-03 14:38:42 +0200432 smc_llc_cli_add_link(link, qentry);
Karsten Graul75d320d2018-03-01 13:51:31 +0100433 return 0;
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100434}
435
Hans Wippel41349842018-06-28 19:05:11 +0200436static void smcr_conn_save_peer_info(struct smc_sock *smc,
437 struct smc_clc_msg_accept_confirm *clc)
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100438{
Hans Wippel95d8d2632018-05-18 09:34:13 +0200439 int bufsize = smc_uncompress_bufsize(clc->rmbe_size);
440
Hans Wippel92a138e2018-05-18 09:34:12 +0200441 smc->conn.peer_rmbe_idx = clc->rmbe_idx;
Ursula Braun5f083182017-01-09 16:55:22 +0100442 smc->conn.local_tx_ctrl.token = ntohl(clc->rmbe_alert_token);
Hans Wippel95d8d2632018-05-18 09:34:13 +0200443 smc->conn.peer_rmbe_size = bufsize;
Ursula Brauncd6851f2017-01-09 16:55:18 +0100444 atomic_set(&smc->conn.peer_rmbe_space, smc->conn.peer_rmbe_size);
Hans Wippel95d8d2632018-05-18 09:34:13 +0200445 smc->conn.tx_off = bufsize * (smc->conn.peer_rmbe_idx - 1);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100446}
447
Hans Wippel41349842018-06-28 19:05:11 +0200448static void smcd_conn_save_peer_info(struct smc_sock *smc,
449 struct smc_clc_msg_accept_confirm *clc)
450{
451 int bufsize = smc_uncompress_bufsize(clc->dmbe_size);
452
453 smc->conn.peer_rmbe_idx = clc->dmbe_idx;
454 smc->conn.peer_token = clc->token;
455 /* msg header takes up space in the buffer */
456 smc->conn.peer_rmbe_size = bufsize - sizeof(struct smcd_cdc_msg);
457 atomic_set(&smc->conn.peer_rmbe_space, smc->conn.peer_rmbe_size);
458 smc->conn.tx_off = bufsize * smc->conn.peer_rmbe_idx;
459}
460
461static void smc_conn_save_peer_info(struct smc_sock *smc,
462 struct smc_clc_msg_accept_confirm *clc)
463{
464 if (smc->conn.lgr->is_smcd)
465 smcd_conn_save_peer_info(smc, clc);
466 else
467 smcr_conn_save_peer_info(smc, clc);
468}
469
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100470static void smc_link_save_peer_info(struct smc_link *link,
471 struct smc_clc_msg_accept_confirm *clc)
472{
473 link->peer_qpn = ntoh24(clc->qpn);
474 memcpy(link->peer_gid, clc->lcl.gid, SMC_GID_SIZE);
475 memcpy(link->peer_mac, clc->lcl.mac, sizeof(link->peer_mac));
476 link->peer_psn = ntoh24(clc->psn);
477 link->peer_mtu = clc->qp_mtu;
478}
479
Ursula Braun07603b22019-04-11 11:17:32 +0200480static void smc_switch_to_fallback(struct smc_sock *smc)
481{
482 smc->use_fallback = true;
483 if (smc->sk.sk_socket && smc->sk.sk_socket->file) {
484 smc->clcsock->file = smc->sk.sk_socket->file;
485 smc->clcsock->file->private_data = smc->clcsock;
Ursula Braun67f562e2020-02-14 08:58:59 +0100486 smc->clcsock->wq.fasync_list =
487 smc->sk.sk_socket->wq.fasync_list;
Ursula Braun07603b22019-04-11 11:17:32 +0200488 }
489}
490
Hans Wippel3b2dec22018-05-18 09:34:18 +0200491/* fall back during connect */
Karsten Graul603cc142018-07-25 16:35:32 +0200492static int smc_connect_fallback(struct smc_sock *smc, int reason_code)
Hans Wippel3b2dec22018-05-18 09:34:18 +0200493{
Ursula Braun07603b22019-04-11 11:17:32 +0200494 smc_switch_to_fallback(smc);
Karsten Graul603cc142018-07-25 16:35:32 +0200495 smc->fallback_rsn = reason_code;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200496 smc_copy_sock_settings_to_clc(smc);
Ursula Braun50717a32019-04-12 12:57:23 +0200497 smc->connect_nonblock = 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200498 if (smc->sk.sk_state == SMC_INIT)
499 smc->sk.sk_state = SMC_ACTIVE;
500 return 0;
501}
502
503/* decline and fall back during connect */
504static int smc_connect_decline_fallback(struct smc_sock *smc, int reason_code)
505{
506 int rc;
507
Ursula Braune1bbdd52018-07-05 16:15:30 +0200508 if (reason_code < 0) { /* error, fallback is not possible */
509 if (smc->sk.sk_state == SMC_INIT)
510 sock_put(&smc->sk); /* passive closing */
Hans Wippel3b2dec22018-05-18 09:34:18 +0200511 return reason_code;
Ursula Braune1bbdd52018-07-05 16:15:30 +0200512 }
Karsten Graul603cc142018-07-25 16:35:32 +0200513 if (reason_code != SMC_CLC_DECL_PEERDECL) {
Hans Wippel3b2dec22018-05-18 09:34:18 +0200514 rc = smc_clc_send_decline(smc, reason_code);
Ursula Braune1bbdd52018-07-05 16:15:30 +0200515 if (rc < 0) {
516 if (smc->sk.sk_state == SMC_INIT)
517 sock_put(&smc->sk); /* passive closing */
Hans Wippel3b2dec22018-05-18 09:34:18 +0200518 return rc;
Ursula Braune1bbdd52018-07-05 16:15:30 +0200519 }
Hans Wippel3b2dec22018-05-18 09:34:18 +0200520 }
Karsten Graul603cc142018-07-25 16:35:32 +0200521 return smc_connect_fallback(smc, reason_code);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200522}
523
524/* abort connecting */
525static int smc_connect_abort(struct smc_sock *smc, int reason_code,
526 int local_contact)
527{
Ursula Braun51e3dfa2020-02-25 16:34:36 +0100528 bool is_smcd = smc->conn.lgr->is_smcd;
529
Hans Wippel3b2dec22018-05-18 09:34:18 +0200530 if (local_contact == SMC_FIRST_CONTACT)
Ursula Braun51e3dfa2020-02-25 16:34:36 +0100531 smc_lgr_cleanup_early(&smc->conn);
532 else
533 smc_conn_free(&smc->conn);
534 if (is_smcd)
Hans Wippel72a36a82019-02-07 15:56:18 +0100535 /* there is only one lgr role for SMC-D; use server lock */
536 mutex_unlock(&smc_server_lgr_pending);
537 else
538 mutex_unlock(&smc_client_lgr_pending);
539
Ursula Braun50717a32019-04-12 12:57:23 +0200540 smc->connect_nonblock = 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200541 return reason_code;
542}
543
544/* check if there is a rdma device available for this connection. */
545/* called for connect and listen */
Karsten Graul228bae02019-04-12 12:57:28 +0200546static int smc_find_rdma_device(struct smc_sock *smc, struct smc_init_info *ini)
Hans Wippel3b2dec22018-05-18 09:34:18 +0200547{
Hans Wippel3b2dec22018-05-18 09:34:18 +0200548 /* PNET table look up: search active ib_device and port
549 * within same PNETID that also contains the ethernet device
550 * used for the internal TCP socket
551 */
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200552 smc_pnet_find_roce_resource(smc->clcsock->sk, ini);
Karsten Graul9aa68d22019-04-12 12:57:29 +0200553 if (!ini->ib_dev)
554 return SMC_CLC_DECL_NOSMCRDEV;
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200555 return 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200556}
557
Hans Wippel41349842018-06-28 19:05:11 +0200558/* check if there is an ISM device available for this connection. */
559/* called for connect and listen */
Karsten Graul228bae02019-04-12 12:57:28 +0200560static int smc_find_ism_device(struct smc_sock *smc, struct smc_init_info *ini)
Hans Wippel41349842018-06-28 19:05:11 +0200561{
562 /* Find ISM device with same PNETID as connecting interface */
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200563 smc_pnet_find_ism_resource(smc->clcsock->sk, ini);
564 if (!ini->ism_dev)
Karsten Graul9aa68d22019-04-12 12:57:29 +0200565 return SMC_CLC_DECL_NOSMCDDEV;
Hans Wippel41349842018-06-28 19:05:11 +0200566 return 0;
567}
568
569/* Check for VLAN ID and register it on ISM device just for CLC handshake */
570static int smc_connect_ism_vlan_setup(struct smc_sock *smc,
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200571 struct smc_init_info *ini)
Hans Wippel41349842018-06-28 19:05:11 +0200572{
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200573 if (ini->vlan_id && smc_ism_get_vlan(ini->ism_dev, ini->vlan_id))
Karsten Graul7a627252019-04-12 12:57:30 +0200574 return SMC_CLC_DECL_ISMVLANERR;
Hans Wippel41349842018-06-28 19:05:11 +0200575 return 0;
576}
577
578/* cleanup temporary VLAN ID registration used for CLC handshake. If ISM is
579 * used, the VLAN ID will be registered again during the connection setup.
580 */
581static int smc_connect_ism_vlan_cleanup(struct smc_sock *smc, bool is_smcd,
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200582 struct smc_init_info *ini)
Hans Wippel41349842018-06-28 19:05:11 +0200583{
584 if (!is_smcd)
585 return 0;
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200586 if (ini->vlan_id && smc_ism_put_vlan(ini->ism_dev, ini->vlan_id))
Hans Wippel41349842018-06-28 19:05:11 +0200587 return SMC_CLC_DECL_CNFERR;
588 return 0;
589}
590
Hans Wippel3b2dec22018-05-18 09:34:18 +0200591/* CLC handshake during connect */
Hans Wippelc758dfd2018-06-28 19:05:09 +0200592static int smc_connect_clc(struct smc_sock *smc, int smc_type,
Hans Wippel3b2dec22018-05-18 09:34:18 +0200593 struct smc_clc_msg_accept_confirm *aclc,
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200594 struct smc_init_info *ini)
Hans Wippel3b2dec22018-05-18 09:34:18 +0200595{
596 int rc = 0;
597
598 /* do inband token exchange */
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200599 rc = smc_clc_send_proposal(smc, smc_type, ini);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200600 if (rc)
601 return rc;
602 /* receive SMC Accept CLC message */
Ursula Braun2b59f582018-11-22 10:26:39 +0100603 return smc_clc_wait_msg(smc, aclc, sizeof(*aclc), SMC_CLC_ACCEPT,
604 CLC_WAIT_TIME);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200605}
606
Ursula Brauna046d572017-01-09 16:55:16 +0100607/* setup for RDMA connection of client */
Hans Wippel3b2dec22018-05-18 09:34:18 +0200608static int smc_connect_rdma(struct smc_sock *smc,
609 struct smc_clc_msg_accept_confirm *aclc,
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200610 struct smc_init_info *ini)
Hans Wippel3b2dec22018-05-18 09:34:18 +0200611{
Karsten Graul0fb0b022020-04-30 15:55:43 +0200612 int i, reason_code = 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200613 struct smc_link *link;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200614
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200615 ini->is_smcd = false;
616 ini->ib_lcl = &aclc->lcl;
617 ini->ib_clcqpn = ntoh24(aclc->qpn);
618 ini->srv_first_contact = aclc->hdr.flag;
619
Hans Wippel72a36a82019-02-07 15:56:18 +0100620 mutex_lock(&smc_client_lgr_pending);
Karsten Graul7a627252019-04-12 12:57:30 +0200621 reason_code = smc_conn_create(smc, ini);
622 if (reason_code) {
Hans Wippel72a36a82019-02-07 15:56:18 +0100623 mutex_unlock(&smc_client_lgr_pending);
624 return reason_code;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200625 }
Hans Wippel3b2dec22018-05-18 09:34:18 +0200626
627 smc_conn_save_peer_info(smc, aclc);
628
Karsten Graul0fb0b022020-04-30 15:55:43 +0200629 if (ini->cln_first_contact == SMC_FIRST_CONTACT) {
630 link = smc->conn.lnk;
631 } else {
632 /* set link that was assigned by server */
633 link = NULL;
634 for (i = 0; i < SMC_LINKS_PER_LGR_MAX; i++) {
635 struct smc_link *l = &smc->conn.lgr->lnk[i];
636
Karsten Graul7df8bcb2020-07-18 15:06:11 +0200637 if (l->peer_qpn == ntoh24(aclc->qpn) &&
638 !memcmp(l->peer_gid, &aclc->lcl.gid, SMC_GID_SIZE) &&
639 !memcmp(l->peer_mac, &aclc->lcl.mac, sizeof(l->peer_mac))) {
Karsten Graul0fb0b022020-04-30 15:55:43 +0200640 link = l;
641 break;
642 }
643 }
644 if (!link)
645 return smc_connect_abort(smc, SMC_CLC_DECL_NOSRVLINK,
646 ini->cln_first_contact);
647 smc->conn.lnk = link;
648 }
649
Hans Wippel3b2dec22018-05-18 09:34:18 +0200650 /* create send buffer and rmb */
Hans Wippelc6ba7c92018-06-28 19:05:07 +0200651 if (smc_buf_create(smc, false))
Karsten Graul7a627252019-04-12 12:57:30 +0200652 return smc_connect_abort(smc, SMC_CLC_DECL_MEM,
653 ini->cln_first_contact);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200654
Karsten Graul7a627252019-04-12 12:57:30 +0200655 if (ini->cln_first_contact == SMC_FIRST_CONTACT)
Hans Wippel3b2dec22018-05-18 09:34:18 +0200656 smc_link_save_peer_info(link, aclc);
657
Karsten Graule07d31d2020-04-29 17:10:42 +0200658 if (smc_rmb_rtoken_handling(&smc->conn, link, aclc))
Karsten Graul603cc142018-07-25 16:35:32 +0200659 return smc_connect_abort(smc, SMC_CLC_DECL_ERR_RTOK,
Karsten Graul7a627252019-04-12 12:57:30 +0200660 ini->cln_first_contact);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200661
662 smc_close_init(smc);
663 smc_rx_init(smc);
664
Karsten Graul7a627252019-04-12 12:57:30 +0200665 if (ini->cln_first_contact == SMC_FIRST_CONTACT) {
Hans Wippel3b2dec22018-05-18 09:34:18 +0200666 if (smc_ib_ready_link(link))
Karsten Graul603cc142018-07-25 16:35:32 +0200667 return smc_connect_abort(smc, SMC_CLC_DECL_ERR_RDYLNK,
Karsten Graul7a627252019-04-12 12:57:30 +0200668 ini->cln_first_contact);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200669 } else {
Karsten Graul7562a132020-05-01 12:48:01 +0200670 if (smcr_lgr_reg_rmbs(link, smc->conn.rmb_desc))
Karsten Graul603cc142018-07-25 16:35:32 +0200671 return smc_connect_abort(smc, SMC_CLC_DECL_ERR_REGRMB,
Karsten Graul7a627252019-04-12 12:57:30 +0200672 ini->cln_first_contact);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200673 }
674 smc_rmb_sync_sg_for_device(&smc->conn);
675
676 reason_code = smc_clc_send_confirm(smc);
677 if (reason_code)
Karsten Graul7a627252019-04-12 12:57:30 +0200678 return smc_connect_abort(smc, reason_code,
679 ini->cln_first_contact);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200680
681 smc_tx_init(smc);
682
Karsten Graul7a627252019-04-12 12:57:30 +0200683 if (ini->cln_first_contact == SMC_FIRST_CONTACT) {
Hans Wippel3b2dec22018-05-18 09:34:18 +0200684 /* QP confirmation over RoCE fabric */
Karsten Graul0fb0b022020-04-30 15:55:43 +0200685 smc_llc_flow_initiate(link->lgr, SMC_LLC_FLOW_ADD_LINK);
Karsten Graulb9247542020-04-29 17:10:41 +0200686 reason_code = smcr_clnt_conf_first_link(smc);
Karsten Graul0fb0b022020-04-30 15:55:43 +0200687 smc_llc_flow_stop(link->lgr, &link->lgr->llc_flow_lcl);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200688 if (reason_code)
689 return smc_connect_abort(smc, reason_code,
Karsten Graul7a627252019-04-12 12:57:30 +0200690 ini->cln_first_contact);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200691 }
Hans Wippel72a36a82019-02-07 15:56:18 +0100692 mutex_unlock(&smc_client_lgr_pending);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200693
694 smc_copy_sock_settings_to_clc(smc);
Ursula Braun50717a32019-04-12 12:57:23 +0200695 smc->connect_nonblock = 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +0200696 if (smc->sk.sk_state == SMC_INIT)
697 smc->sk.sk_state = SMC_ACTIVE;
698
699 return 0;
700}
701
Hans Wippel41349842018-06-28 19:05:11 +0200702/* setup for ISM connection of client */
703static int smc_connect_ism(struct smc_sock *smc,
704 struct smc_clc_msg_accept_confirm *aclc,
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200705 struct smc_init_info *ini)
Hans Wippel41349842018-06-28 19:05:11 +0200706{
Hans Wippel41349842018-06-28 19:05:11 +0200707 int rc = 0;
708
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200709 ini->is_smcd = true;
710 ini->ism_gid = aclc->gid;
711 ini->srv_first_contact = aclc->hdr.flag;
712
Hans Wippel72a36a82019-02-07 15:56:18 +0100713 /* there is only one lgr role for SMC-D; use server lock */
714 mutex_lock(&smc_server_lgr_pending);
Karsten Graul7a627252019-04-12 12:57:30 +0200715 rc = smc_conn_create(smc, ini);
716 if (rc) {
Hans Wippel72a36a82019-02-07 15:56:18 +0100717 mutex_unlock(&smc_server_lgr_pending);
Karsten Graul7a627252019-04-12 12:57:30 +0200718 return rc;
Hans Wippel72a36a82019-02-07 15:56:18 +0100719 }
Hans Wippel41349842018-06-28 19:05:11 +0200720
721 /* Create send and receive buffers */
Karsten Graul72b7f6c2020-07-26 20:34:28 +0200722 rc = smc_buf_create(smc, true);
723 if (rc)
724 return smc_connect_abort(smc, (rc == -ENOSPC) ?
725 SMC_CLC_DECL_MAX_DMB :
726 SMC_CLC_DECL_MEM,
Karsten Graul7a627252019-04-12 12:57:30 +0200727 ini->cln_first_contact);
Hans Wippel41349842018-06-28 19:05:11 +0200728
729 smc_conn_save_peer_info(smc, aclc);
730 smc_close_init(smc);
731 smc_rx_init(smc);
732 smc_tx_init(smc);
733
734 rc = smc_clc_send_confirm(smc);
735 if (rc)
Karsten Graul7a627252019-04-12 12:57:30 +0200736 return smc_connect_abort(smc, rc, ini->cln_first_contact);
Hans Wippel72a36a82019-02-07 15:56:18 +0100737 mutex_unlock(&smc_server_lgr_pending);
Hans Wippel41349842018-06-28 19:05:11 +0200738
739 smc_copy_sock_settings_to_clc(smc);
Ursula Braun50717a32019-04-12 12:57:23 +0200740 smc->connect_nonblock = 0;
Hans Wippel41349842018-06-28 19:05:11 +0200741 if (smc->sk.sk_state == SMC_INIT)
742 smc->sk.sk_state = SMC_ACTIVE;
743
744 return 0;
745}
746
Hans Wippel3b2dec22018-05-18 09:34:18 +0200747/* perform steps before actually connecting */
748static int __smc_connect(struct smc_sock *smc)
Ursula Brauna046d572017-01-09 16:55:16 +0100749{
Hans Wippel41349842018-06-28 19:05:11 +0200750 bool ism_supported = false, rdma_supported = false;
Ursula Brauna046d572017-01-09 16:55:16 +0100751 struct smc_clc_msg_accept_confirm aclc;
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200752 struct smc_init_info ini = {0};
Hans Wippel41349842018-06-28 19:05:11 +0200753 int smc_type;
Ursula Brauna046d572017-01-09 16:55:16 +0100754 int rc = 0;
Ursula Brauna046d572017-01-09 16:55:16 +0100755
Ursula Braunee9dfbe2018-04-26 17:18:21 +0200756 if (smc->use_fallback)
Karsten Graul603cc142018-07-25 16:35:32 +0200757 return smc_connect_fallback(smc, smc->fallback_rsn);
Ursula Braunee9dfbe2018-04-26 17:18:21 +0200758
Hans Wippel3b2dec22018-05-18 09:34:18 +0200759 /* if peer has not signalled SMC-capability, fall back */
760 if (!tcp_sk(smc->clcsock->sk)->syn_smc)
Karsten Graul603cc142018-07-25 16:35:32 +0200761 return smc_connect_fallback(smc, SMC_CLC_DECL_PEERNOSMC);
Ursula Braunc5c1cc92017-10-25 11:01:46 +0200762
Ursula Brauna046d572017-01-09 16:55:16 +0100763 /* IPSec connections opt out of SMC-R optimizations */
Hans Wippel3b2dec22018-05-18 09:34:18 +0200764 if (using_ipsec(smc))
765 return smc_connect_decline_fallback(smc, SMC_CLC_DECL_IPSEC);
Ursula Brauna046d572017-01-09 16:55:16 +0100766
Karsten Graulfba7e8e2019-04-12 12:57:27 +0200767 /* get vlan id from IP device */
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200768 if (smc_vlan_by_tcpsk(smc->clcsock, &ini))
Karsten Graulfba7e8e2019-04-12 12:57:27 +0200769 return smc_connect_decline_fallback(smc,
770 SMC_CLC_DECL_GETVLANERR);
Hans Wippel41349842018-06-28 19:05:11 +0200771
772 /* check if there is an ism device available */
Karsten Graul228bae02019-04-12 12:57:28 +0200773 if (!smc_find_ism_device(smc, &ini) &&
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200774 !smc_connect_ism_vlan_setup(smc, &ini)) {
Hans Wippel41349842018-06-28 19:05:11 +0200775 /* ISM is supported for this connection */
776 ism_supported = true;
777 smc_type = SMC_TYPE_D;
778 }
779
780 /* check if there is a rdma device available */
Karsten Graul228bae02019-04-12 12:57:28 +0200781 if (!smc_find_rdma_device(smc, &ini)) {
Hans Wippel41349842018-06-28 19:05:11 +0200782 /* RDMA is supported for this connection */
783 rdma_supported = true;
784 if (ism_supported)
785 smc_type = SMC_TYPE_B; /* both */
786 else
787 smc_type = SMC_TYPE_R; /* only RDMA */
788 }
789
790 /* if neither ISM nor RDMA are supported, fallback */
791 if (!rdma_supported && !ism_supported)
Karsten Graul603cc142018-07-25 16:35:32 +0200792 return smc_connect_decline_fallback(smc, SMC_CLC_DECL_NOSMCDEV);
Ursula Brauna046d572017-01-09 16:55:16 +0100793
Hans Wippel3b2dec22018-05-18 09:34:18 +0200794 /* perform CLC handshake */
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200795 rc = smc_connect_clc(smc, smc_type, &aclc, &ini);
Hans Wippel41349842018-06-28 19:05:11 +0200796 if (rc) {
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200797 smc_connect_ism_vlan_cleanup(smc, ism_supported, &ini);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200798 return smc_connect_decline_fallback(smc, rc);
Hans Wippel41349842018-06-28 19:05:11 +0200799 }
Ursula Brauna046d572017-01-09 16:55:16 +0100800
Hans Wippel41349842018-06-28 19:05:11 +0200801 /* depending on previous steps, connect using rdma or ism */
802 if (rdma_supported && aclc.hdr.path == SMC_TYPE_R)
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200803 rc = smc_connect_rdma(smc, &aclc, &ini);
Hans Wippel41349842018-06-28 19:05:11 +0200804 else if (ism_supported && aclc.hdr.path == SMC_TYPE_D)
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200805 rc = smc_connect_ism(smc, &aclc, &ini);
Hans Wippel41349842018-06-28 19:05:11 +0200806 else
Karsten Graul603cc142018-07-25 16:35:32 +0200807 rc = SMC_CLC_DECL_MODEUNSUPP;
Hans Wippel41349842018-06-28 19:05:11 +0200808 if (rc) {
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200809 smc_connect_ism_vlan_cleanup(smc, ism_supported, &ini);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200810 return smc_connect_decline_fallback(smc, rc);
Hans Wippel41349842018-06-28 19:05:11 +0200811 }
Ursula Brauna046d572017-01-09 16:55:16 +0100812
Karsten Graulbc36d2f2019-04-12 12:57:26 +0200813 smc_connect_ism_vlan_cleanup(smc, ism_supported, &ini);
Hans Wippel3b2dec22018-05-18 09:34:18 +0200814 return 0;
Ursula Brauna046d572017-01-09 16:55:16 +0100815}
816
Ursula Braun24ac3a02018-06-27 17:59:50 +0200817static void smc_connect_work(struct work_struct *work)
818{
819 struct smc_sock *smc = container_of(work, struct smc_sock,
820 connect_work);
Ursula Braun50717a32019-04-12 12:57:23 +0200821 long timeo = smc->sk.sk_sndtimeo;
822 int rc = 0;
Ursula Braun24ac3a02018-06-27 17:59:50 +0200823
Ursula Braun50717a32019-04-12 12:57:23 +0200824 if (!timeo)
825 timeo = MAX_SCHEDULE_TIMEOUT;
826 lock_sock(smc->clcsock->sk);
Ursula Braun24ac3a02018-06-27 17:59:50 +0200827 if (smc->clcsock->sk->sk_err) {
828 smc->sk.sk_err = smc->clcsock->sk->sk_err;
Ursula Braun50717a32019-04-12 12:57:23 +0200829 } else if ((1 << smc->clcsock->sk->sk_state) &
830 (TCPF_SYN_SENT | TCP_SYN_RECV)) {
831 rc = sk_stream_wait_connect(smc->clcsock->sk, &timeo);
832 if ((rc == -EPIPE) &&
833 ((1 << smc->clcsock->sk->sk_state) &
834 (TCPF_ESTABLISHED | TCPF_CLOSE_WAIT)))
835 rc = 0;
Ursula Braun24ac3a02018-06-27 17:59:50 +0200836 }
Ursula Braun50717a32019-04-12 12:57:23 +0200837 release_sock(smc->clcsock->sk);
838 lock_sock(&smc->sk);
839 if (rc != 0 || smc->sk.sk_err) {
840 smc->sk.sk_state = SMC_CLOSED;
841 if (rc == -EPIPE || rc == -EAGAIN)
842 smc->sk.sk_err = EPIPE;
843 else if (signal_pending(current))
844 smc->sk.sk_err = -sock_intr_errno(timeo);
Ursula Braun6d6dd522019-11-12 16:03:41 +0100845 sock_put(&smc->sk); /* passive closing */
Ursula Braun24ac3a02018-06-27 17:59:50 +0200846 goto out;
847 }
848
849 rc = __smc_connect(smc);
850 if (rc < 0)
851 smc->sk.sk_err = -rc;
852
853out:
Ursula Braun07603b22019-04-11 11:17:32 +0200854 if (!sock_flag(&smc->sk, SOCK_DEAD)) {
855 if (smc->sk.sk_err) {
856 smc->sk.sk_state_change(&smc->sk);
857 } else { /* allow polling before and after fallback decision */
858 smc->clcsock->sk->sk_write_space(smc->clcsock->sk);
859 smc->sk.sk_write_space(&smc->sk);
860 }
861 }
Ursula Braun24ac3a02018-06-27 17:59:50 +0200862 release_sock(&smc->sk);
863}
864
Ursula Braunac713872017-01-09 16:55:13 +0100865static int smc_connect(struct socket *sock, struct sockaddr *addr,
866 int alen, int flags)
867{
868 struct sock *sk = sock->sk;
869 struct smc_sock *smc;
870 int rc = -EINVAL;
871
872 smc = smc_sk(sk);
873
874 /* separate smc parameter checking to be safe */
875 if (alen < sizeof(addr->sa_family))
876 goto out_err;
Karsten Graulaaa4d332018-03-16 15:06:41 +0100877 if (addr->sa_family != AF_INET && addr->sa_family != AF_INET6)
Ursula Braunac713872017-01-09 16:55:13 +0100878 goto out_err;
879
880 lock_sock(sk);
881 switch (sk->sk_state) {
882 default:
883 goto out;
884 case SMC_ACTIVE:
885 rc = -EISCONN;
886 goto out;
887 case SMC_INIT:
888 rc = 0;
889 break;
890 }
891
892 smc_copy_sock_settings_to_clc(smc);
Ursula Braunc5c1cc92017-10-25 11:01:46 +0200893 tcp_sk(smc->clcsock->sk)->syn_smc = 1;
Ursula Braun50717a32019-04-12 12:57:23 +0200894 if (smc->connect_nonblock) {
895 rc = -EALREADY;
896 goto out;
897 }
898 rc = kernel_connect(smc->clcsock, addr, alen, flags);
899 if (rc && rc != -EINPROGRESS)
900 goto out;
Ursula Braun301428e2019-10-29 12:41:26 +0100901
902 sock_hold(&smc->sk); /* sock put in passive closing */
Ursula Braun86434742019-12-12 22:35:58 +0100903 if (smc->use_fallback)
904 goto out;
Ursula Braun24ac3a02018-06-27 17:59:50 +0200905 if (flags & O_NONBLOCK) {
Ursula Braun50717a32019-04-12 12:57:23 +0200906 if (schedule_work(&smc->connect_work))
907 smc->connect_nonblock = 1;
Ursula Braun24ac3a02018-06-27 17:59:50 +0200908 rc = -EINPROGRESS;
909 } else {
Ursula Braun24ac3a02018-06-27 17:59:50 +0200910 rc = __smc_connect(smc);
911 if (rc < 0)
912 goto out;
913 else
914 rc = 0; /* success cases including fallback */
915 }
Ursula Braunac713872017-01-09 16:55:13 +0100916
917out:
918 release_sock(sk);
919out_err:
920 return rc;
921}
922
923static int smc_clcsock_accept(struct smc_sock *lsmc, struct smc_sock **new_smc)
924{
Ursula Braun3163c502018-01-24 10:28:12 +0100925 struct socket *new_clcsock = NULL;
926 struct sock *lsk = &lsmc->sk;
Ursula Braunac713872017-01-09 16:55:13 +0100927 struct sock *new_sk;
Myungho Jung78abe3d2018-12-18 09:02:25 -0800928 int rc = -EINVAL;
Ursula Braunac713872017-01-09 16:55:13 +0100929
Ursula Braun3163c502018-01-24 10:28:12 +0100930 release_sock(lsk);
Karsten Graulaaa4d332018-03-16 15:06:41 +0100931 new_sk = smc_sock_alloc(sock_net(lsk), NULL, lsk->sk_protocol);
Ursula Braunac713872017-01-09 16:55:13 +0100932 if (!new_sk) {
933 rc = -ENOMEM;
Ursula Braun3163c502018-01-24 10:28:12 +0100934 lsk->sk_err = ENOMEM;
Ursula Braunac713872017-01-09 16:55:13 +0100935 *new_smc = NULL;
Ursula Braun3163c502018-01-24 10:28:12 +0100936 lock_sock(lsk);
Ursula Braunac713872017-01-09 16:55:13 +0100937 goto out;
938 }
939 *new_smc = smc_sk(new_sk);
940
Myungho Jung78abe3d2018-12-18 09:02:25 -0800941 mutex_lock(&lsmc->clcsock_release_lock);
942 if (lsmc->clcsock)
Ursula Brauna60a2b12020-09-10 18:48:20 +0200943 rc = kernel_accept(lsmc->clcsock, &new_clcsock, SOCK_NONBLOCK);
Myungho Jung78abe3d2018-12-18 09:02:25 -0800944 mutex_unlock(&lsmc->clcsock_release_lock);
Ursula Braun3163c502018-01-24 10:28:12 +0100945 lock_sock(lsk);
Ursula Brauna60a2b12020-09-10 18:48:20 +0200946 if (rc < 0 && rc != -EAGAIN)
Ursula Braun3163c502018-01-24 10:28:12 +0100947 lsk->sk_err = -rc;
Ursula Braun35a6b172018-01-24 10:28:13 +0100948 if (rc < 0 || lsk->sk_state == SMC_CLOSED) {
Ursula Braunf61bca52019-04-11 11:17:34 +0200949 new_sk->sk_prot->unhash(new_sk);
Ursula Brauna046d572017-01-09 16:55:16 +0100950 if (new_clcsock)
951 sock_release(new_clcsock);
952 new_sk->sk_state = SMC_CLOSED;
953 sock_set_flag(new_sk, SOCK_DEAD);
Ursula Braun51f1de72018-01-26 09:28:48 +0100954 sock_put(new_sk); /* final */
Ursula Braunac713872017-01-09 16:55:13 +0100955 *new_smc = NULL;
956 goto out;
957 }
958
Ursula Brauna60a2b12020-09-10 18:48:20 +0200959 /* new clcsock has inherited the smc listen-specific sk_data_ready
960 * function; switch it back to the original sk_data_ready function
961 */
962 new_clcsock->sk->sk_data_ready = lsmc->clcsk_data_ready;
Ursula Braunac713872017-01-09 16:55:13 +0100963 (*new_smc)->clcsock = new_clcsock;
964out:
965 return rc;
966}
967
Ursula Brauna046d572017-01-09 16:55:16 +0100968/* add a just created sock to the accept queue of the listen sock as
969 * candidate for a following socket accept call from user space
970 */
971static void smc_accept_enqueue(struct sock *parent, struct sock *sk)
972{
973 struct smc_sock *par = smc_sk(parent);
974
Ursula Braun51f1de72018-01-26 09:28:48 +0100975 sock_hold(sk); /* sock_put in smc_accept_unlink () */
Ursula Brauna046d572017-01-09 16:55:16 +0100976 spin_lock(&par->accept_q_lock);
977 list_add_tail(&smc_sk(sk)->accept_q, &par->accept_q);
978 spin_unlock(&par->accept_q_lock);
979 sk_acceptq_added(parent);
980}
981
982/* remove a socket from the accept queue of its parental listening socket */
983static void smc_accept_unlink(struct sock *sk)
984{
985 struct smc_sock *par = smc_sk(sk)->listen_smc;
986
987 spin_lock(&par->accept_q_lock);
988 list_del_init(&smc_sk(sk)->accept_q);
989 spin_unlock(&par->accept_q_lock);
990 sk_acceptq_removed(&smc_sk(sk)->listen_smc->sk);
Ursula Braun51f1de72018-01-26 09:28:48 +0100991 sock_put(sk); /* sock_hold in smc_accept_enqueue */
Ursula Brauna046d572017-01-09 16:55:16 +0100992}
993
994/* remove a sock from the accept queue to bind it to a new socket created
995 * for a socket accept call from user space
996 */
Ursula Braunb38d7322017-01-09 16:55:25 +0100997struct sock *smc_accept_dequeue(struct sock *parent,
998 struct socket *new_sock)
Ursula Brauna046d572017-01-09 16:55:16 +0100999{
1000 struct smc_sock *isk, *n;
1001 struct sock *new_sk;
1002
1003 list_for_each_entry_safe(isk, n, &smc_sk(parent)->accept_q, accept_q) {
1004 new_sk = (struct sock *)isk;
1005
1006 smc_accept_unlink(new_sk);
1007 if (new_sk->sk_state == SMC_CLOSED) {
Ursula Braunf61bca52019-04-11 11:17:34 +02001008 new_sk->sk_prot->unhash(new_sk);
Ursula Braun127f4972018-01-26 09:28:49 +01001009 if (isk->clcsock) {
1010 sock_release(isk->clcsock);
1011 isk->clcsock = NULL;
1012 }
Ursula Braun51f1de72018-01-26 09:28:48 +01001013 sock_put(new_sk); /* final */
Ursula Brauna046d572017-01-09 16:55:16 +01001014 continue;
1015 }
Ursula Braun07603b22019-04-11 11:17:32 +02001016 if (new_sock) {
Ursula Brauna046d572017-01-09 16:55:16 +01001017 sock_graft(new_sk, new_sock);
Ursula Braun07603b22019-04-11 11:17:32 +02001018 if (isk->use_fallback) {
1019 smc_sk(new_sk)->clcsock->file = new_sock->file;
1020 isk->clcsock->file->private_data = isk->clcsock;
1021 }
1022 }
Ursula Brauna046d572017-01-09 16:55:16 +01001023 return new_sk;
1024 }
1025 return NULL;
1026}
1027
1028/* clean up for a created but never accepted sock */
Ursula Braunb38d7322017-01-09 16:55:25 +01001029void smc_close_non_accepted(struct sock *sk)
Ursula Brauna046d572017-01-09 16:55:16 +01001030{
1031 struct smc_sock *smc = smc_sk(sk);
1032
Ursula Braun81cf4f42019-10-21 16:13:15 +02001033 sock_hold(sk); /* sock_put below */
Ursula Braunb38d7322017-01-09 16:55:25 +01001034 lock_sock(sk);
1035 if (!sk->sk_lingertime)
1036 /* wait for peer closing */
1037 sk->sk_lingertime = SMC_MAX_STREAM_WAIT_TIMEOUT;
Ursula Braun39f41f32019-06-27 15:04:52 +02001038 __smc_release(smc);
Ursula Braunb38d7322017-01-09 16:55:25 +01001039 release_sock(sk);
Ursula Braun81cf4f42019-10-21 16:13:15 +02001040 sock_put(sk); /* sock_hold above */
Ursula Braun51f1de72018-01-26 09:28:48 +01001041 sock_put(sk); /* final sock_put */
Ursula Brauna046d572017-01-09 16:55:16 +01001042}
1043
Karsten Graulb9247542020-04-29 17:10:41 +02001044static int smcr_serv_conf_first_link(struct smc_sock *smc)
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001045{
Karsten Graul387707f2020-04-29 17:10:40 +02001046 struct smc_link *link = smc->conn.lnk;
Karsten Graul4667bb42020-04-30 15:55:42 +02001047 struct smc_llc_qentry *qentry;
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001048 int rc;
1049
Karsten Graul7562a132020-05-01 12:48:01 +02001050 if (smcr_link_reg_rmb(link, smc->conn.rmb_desc))
Karsten Graul603cc142018-07-25 16:35:32 +02001051 return SMC_CLC_DECL_ERR_REGRMB;
Ursula Braun652a1e42017-07-28 13:56:17 +02001052
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001053 /* send CONFIRM LINK request to client over the RoCE fabric */
Ursula Braun947541f2018-07-25 16:35:30 +02001054 rc = smc_llc_send_confirm_link(link, SMC_LLC_REQ);
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001055 if (rc < 0)
Karsten Graul603cc142018-07-25 16:35:32 +02001056 return SMC_CLC_DECL_TIMEOUT_CL;
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001057
1058 /* receive CONFIRM LINK response from client over the RoCE fabric */
Karsten Graul4667bb42020-04-30 15:55:42 +02001059 qentry = smc_llc_wait(link->lgr, link, SMC_LLC_WAIT_TIME,
1060 SMC_LLC_CONFIRM_LINK);
1061 if (!qentry) {
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001062 struct smc_clc_msg_decline dclc;
1063
1064 rc = smc_clc_wait_msg(smc, &dclc, sizeof(dclc),
Ursula Braun2b59f582018-11-22 10:26:39 +01001065 SMC_CLC_DECLINE, CLC_WAIT_TIME_SHORT);
Ursula Braun9ed28552018-11-22 10:26:37 +01001066 return rc == -EAGAIN ? SMC_CLC_DECL_TIMEOUT_CL : rc;
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001067 }
Karsten Graul649758f2020-05-04 14:18:48 +02001068 smc_llc_save_peer_uid(qentry);
Karsten Graul4667bb42020-04-30 15:55:42 +02001069 rc = smc_llc_eval_conf_link(qentry, SMC_LLC_RESP);
1070 smc_llc_flow_qentry_del(&link->lgr->llc_flow_lcl);
1071 if (rc)
Karsten Graul75d320d2018-03-01 13:51:31 +01001072 return SMC_CLC_DECL_RMBE_EC;
1073
Karsten Graul4667bb42020-04-30 15:55:42 +02001074 /* confirm_rkey is implicit on 1st contact */
1075 smc->conn.rmb_desc->is_conf_rkey = true;
Karsten Graul52bedf32018-03-01 13:51:32 +01001076
Karsten Graul00a049c2020-04-29 17:10:49 +02001077 smc_llc_link_active(link);
Karsten Graul0a99be42020-05-05 15:01:20 +02001078 smcr_lgr_set_type(link->lgr, SMC_LGR_SINGLE);
Karsten Graul52bedf32018-03-01 13:51:32 +01001079
Karsten Graul4667bb42020-04-30 15:55:42 +02001080 /* initial contact - try to establish second link */
Karsten Graul2d2209f2020-05-03 14:38:43 +02001081 smc_llc_srv_add_link(link);
Karsten Graul75d320d2018-03-01 13:51:31 +01001082 return 0;
Ursula Braun9bf9abe2017-01-09 16:55:21 +01001083}
1084
Hans Wippel3b2dec22018-05-18 09:34:18 +02001085/* listen worker: finish */
1086static void smc_listen_out(struct smc_sock *new_smc)
Ursula Brauna046d572017-01-09 16:55:16 +01001087{
Ursula Brauna046d572017-01-09 16:55:16 +01001088 struct smc_sock *lsmc = new_smc->listen_smc;
Ursula Brauna046d572017-01-09 16:55:16 +01001089 struct sock *newsmcsk = &new_smc->sk;
Ursula Brauna046d572017-01-09 16:55:16 +01001090
Ursula Brauna046d572017-01-09 16:55:16 +01001091 if (lsmc->sk.sk_state == SMC_LISTEN) {
Karsten Graulfd577702019-04-11 11:17:30 +02001092 lock_sock_nested(&lsmc->sk, SINGLE_DEPTH_NESTING);
Ursula Brauna046d572017-01-09 16:55:16 +01001093 smc_accept_enqueue(&lsmc->sk, newsmcsk);
Karsten Graulfd577702019-04-11 11:17:30 +02001094 release_sock(&lsmc->sk);
Ursula Brauna046d572017-01-09 16:55:16 +01001095 } else { /* no longer listening */
1096 smc_close_non_accepted(newsmcsk);
1097 }
Ursula Brauna046d572017-01-09 16:55:16 +01001098
1099 /* Wake up accept */
1100 lsmc->sk.sk_data_ready(&lsmc->sk);
1101 sock_put(&lsmc->sk); /* sock_hold in smc_tcp_listen_work */
Hans Wippel3b2dec22018-05-18 09:34:18 +02001102}
Ursula Brauna046d572017-01-09 16:55:16 +01001103
Hans Wippel3b2dec22018-05-18 09:34:18 +02001104/* listen worker: finish in state connected */
1105static void smc_listen_out_connected(struct smc_sock *new_smc)
1106{
1107 struct sock *newsmcsk = &new_smc->sk;
Ursula Brauna046d572017-01-09 16:55:16 +01001108
Hans Wippel3b2dec22018-05-18 09:34:18 +02001109 sk_refcnt_debug_inc(newsmcsk);
1110 if (newsmcsk->sk_state == SMC_INIT)
1111 newsmcsk->sk_state = SMC_ACTIVE;
1112
1113 smc_listen_out(new_smc);
1114}
1115
1116/* listen worker: finish in error state */
1117static void smc_listen_out_err(struct smc_sock *new_smc)
1118{
1119 struct sock *newsmcsk = &new_smc->sk;
1120
Ursula Braun51f1de72018-01-26 09:28:48 +01001121 if (newsmcsk->sk_state == SMC_INIT)
1122 sock_put(&new_smc->sk); /* passive closing */
Ursula Brauna046d572017-01-09 16:55:16 +01001123 newsmcsk->sk_state = SMC_CLOSED;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001124
1125 smc_listen_out(new_smc);
1126}
1127
1128/* listen worker: decline and fall back if possible */
1129static void smc_listen_decline(struct smc_sock *new_smc, int reason_code,
1130 int local_contact)
1131{
1132 /* RDMA setup failed, switch back to TCP */
1133 if (local_contact == SMC_FIRST_CONTACT)
Ursula Braun51e3dfa2020-02-25 16:34:36 +01001134 smc_lgr_cleanup_early(&new_smc->conn);
1135 else
1136 smc_conn_free(&new_smc->conn);
Hans Wippel3b2dec22018-05-18 09:34:18 +02001137 if (reason_code < 0) { /* error, no fallback possible */
1138 smc_listen_out_err(new_smc);
1139 return;
1140 }
Ursula Braun07603b22019-04-11 11:17:32 +02001141 smc_switch_to_fallback(new_smc);
Karsten Graul603cc142018-07-25 16:35:32 +02001142 new_smc->fallback_rsn = reason_code;
1143 if (reason_code && reason_code != SMC_CLC_DECL_PEERDECL) {
Hans Wippel3b2dec22018-05-18 09:34:18 +02001144 if (smc_clc_send_decline(new_smc, reason_code) < 0) {
1145 smc_listen_out_err(new_smc);
1146 return;
1147 }
1148 }
1149 smc_listen_out_connected(new_smc);
1150}
1151
1152/* listen worker: check prefixes */
Karsten Graul59886692019-04-12 12:57:25 +02001153static int smc_listen_prfx_check(struct smc_sock *new_smc,
Hans Wippel3b2dec22018-05-18 09:34:18 +02001154 struct smc_clc_msg_proposal *pclc)
1155{
1156 struct smc_clc_msg_proposal_prefix *pclc_prfx;
1157 struct socket *newclcsock = new_smc->clcsock;
1158
1159 pclc_prfx = smc_clc_proposal_get_prefix(pclc);
1160 if (smc_clc_prfx_match(newclcsock, pclc_prfx))
Karsten Graul59886692019-04-12 12:57:25 +02001161 return SMC_CLC_DECL_DIFFPREFIX;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001162
1163 return 0;
1164}
1165
1166/* listen worker: initialize connection and buffers */
1167static int smc_listen_rdma_init(struct smc_sock *new_smc,
Karsten Graul7a627252019-04-12 12:57:30 +02001168 struct smc_init_info *ini)
Hans Wippel3b2dec22018-05-18 09:34:18 +02001169{
Karsten Graul7a627252019-04-12 12:57:30 +02001170 int rc;
1171
Hans Wippel3b2dec22018-05-18 09:34:18 +02001172 /* allocate connection / link group */
Karsten Graul7a627252019-04-12 12:57:30 +02001173 rc = smc_conn_create(new_smc, ini);
1174 if (rc)
1175 return rc;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001176
1177 /* create send buffer and rmb */
Hans Wippelc6ba7c92018-06-28 19:05:07 +02001178 if (smc_buf_create(new_smc, false))
Hans Wippel3b2dec22018-05-18 09:34:18 +02001179 return SMC_CLC_DECL_MEM;
1180
1181 return 0;
1182}
1183
Hans Wippel41349842018-06-28 19:05:11 +02001184/* listen worker: initialize connection and buffers for SMC-D */
1185static int smc_listen_ism_init(struct smc_sock *new_smc,
1186 struct smc_clc_msg_proposal *pclc,
Karsten Graul7a627252019-04-12 12:57:30 +02001187 struct smc_init_info *ini)
Hans Wippel41349842018-06-28 19:05:11 +02001188{
1189 struct smc_clc_msg_smcd *pclc_smcd;
Karsten Graul7a627252019-04-12 12:57:30 +02001190 int rc;
Hans Wippel41349842018-06-28 19:05:11 +02001191
1192 pclc_smcd = smc_get_clc_msg_smcd(pclc);
Karsten Graulbc36d2f2019-04-12 12:57:26 +02001193 ini->ism_gid = pclc_smcd->gid;
Karsten Graul7a627252019-04-12 12:57:30 +02001194 rc = smc_conn_create(new_smc, ini);
1195 if (rc)
1196 return rc;
Hans Wippel41349842018-06-28 19:05:11 +02001197
1198 /* Check if peer can be reached via ISM device */
1199 if (smc_ism_cantalk(new_smc->conn.lgr->peer_gid,
1200 new_smc->conn.lgr->vlan_id,
1201 new_smc->conn.lgr->smcd)) {
Karsten Graul7a627252019-04-12 12:57:30 +02001202 if (ini->cln_first_contact == SMC_FIRST_CONTACT)
Ursula Braun51e3dfa2020-02-25 16:34:36 +01001203 smc_lgr_cleanup_early(&new_smc->conn);
1204 else
1205 smc_conn_free(&new_smc->conn);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001206 return SMC_CLC_DECL_SMCDNOTALK;
Hans Wippel41349842018-06-28 19:05:11 +02001207 }
1208
1209 /* Create send and receive buffers */
Karsten Graul72b7f6c2020-07-26 20:34:28 +02001210 rc = smc_buf_create(new_smc, true);
1211 if (rc) {
Karsten Graul7a627252019-04-12 12:57:30 +02001212 if (ini->cln_first_contact == SMC_FIRST_CONTACT)
Ursula Braun51e3dfa2020-02-25 16:34:36 +01001213 smc_lgr_cleanup_early(&new_smc->conn);
1214 else
1215 smc_conn_free(&new_smc->conn);
Karsten Graul72b7f6c2020-07-26 20:34:28 +02001216 return (rc == -ENOSPC) ? SMC_CLC_DECL_MAX_DMB :
1217 SMC_CLC_DECL_MEM;
Hans Wippel41349842018-06-28 19:05:11 +02001218 }
1219
1220 return 0;
1221}
1222
Hans Wippel3b2dec22018-05-18 09:34:18 +02001223/* listen worker: register buffers */
1224static int smc_listen_rdma_reg(struct smc_sock *new_smc, int local_contact)
1225{
Karsten Graulb9247542020-04-29 17:10:41 +02001226 struct smc_connection *conn = &new_smc->conn;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001227
1228 if (local_contact != SMC_FIRST_CONTACT) {
Karsten Graul7562a132020-05-01 12:48:01 +02001229 if (smcr_lgr_reg_rmbs(conn->lnk, conn->rmb_desc))
Karsten Graulc7674c02018-11-22 10:26:43 +01001230 return SMC_CLC_DECL_ERR_REGRMB;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001231 }
1232 smc_rmb_sync_sg_for_device(&new_smc->conn);
1233
1234 return 0;
1235}
1236
1237/* listen worker: finish RDMA setup */
Ursula Braun1ca52fc2018-09-18 15:46:35 +02001238static int smc_listen_rdma_finish(struct smc_sock *new_smc,
1239 struct smc_clc_msg_accept_confirm *cclc,
1240 int local_contact)
Hans Wippel3b2dec22018-05-18 09:34:18 +02001241{
Karsten Graul387707f2020-04-29 17:10:40 +02001242 struct smc_link *link = new_smc->conn.lnk;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001243 int reason_code = 0;
1244
1245 if (local_contact == SMC_FIRST_CONTACT)
1246 smc_link_save_peer_info(link, cclc);
1247
Karsten Graule07d31d2020-04-29 17:10:42 +02001248 if (smc_rmb_rtoken_handling(&new_smc->conn, link, cclc)) {
Karsten Graul603cc142018-07-25 16:35:32 +02001249 reason_code = SMC_CLC_DECL_ERR_RTOK;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001250 goto decline;
1251 }
1252
1253 if (local_contact == SMC_FIRST_CONTACT) {
1254 if (smc_ib_ready_link(link)) {
Karsten Graul603cc142018-07-25 16:35:32 +02001255 reason_code = SMC_CLC_DECL_ERR_RDYLNK;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001256 goto decline;
1257 }
1258 /* QP confirmation over RoCE fabric */
Karsten Graul4667bb42020-04-30 15:55:42 +02001259 smc_llc_flow_initiate(link->lgr, SMC_LLC_FLOW_ADD_LINK);
Karsten Graulb9247542020-04-29 17:10:41 +02001260 reason_code = smcr_serv_conf_first_link(new_smc);
Karsten Graul4667bb42020-04-30 15:55:42 +02001261 smc_llc_flow_stop(link->lgr, &link->lgr->llc_flow_lcl);
Hans Wippel3b2dec22018-05-18 09:34:18 +02001262 if (reason_code)
1263 goto decline;
1264 }
Ursula Braun1ca52fc2018-09-18 15:46:35 +02001265 return 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001266
1267decline:
Hans Wippel3b2dec22018-05-18 09:34:18 +02001268 smc_listen_decline(new_smc, reason_code, local_contact);
Ursula Braun1ca52fc2018-09-18 15:46:35 +02001269 return reason_code;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001270}
1271
1272/* setup for RDMA connection of server */
1273static void smc_listen_work(struct work_struct *work)
1274{
1275 struct smc_sock *new_smc = container_of(work, struct smc_sock,
1276 smc_listen_work);
1277 struct socket *newclcsock = new_smc->clcsock;
1278 struct smc_clc_msg_accept_confirm cclc;
1279 struct smc_clc_msg_proposal *pclc;
Karsten Graulbc36d2f2019-04-12 12:57:26 +02001280 struct smc_init_info ini = {0};
Hans Wippel41349842018-06-28 19:05:11 +02001281 bool ism_supported = false;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001282 u8 buf[SMC_CLC_MAX_LEN];
Hans Wippel3b2dec22018-05-18 09:34:18 +02001283 int rc = 0;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001284
Karsten Graulfd577702019-04-11 11:17:30 +02001285 if (new_smc->listen_smc->sk.sk_state != SMC_LISTEN)
1286 return smc_listen_out_err(new_smc);
1287
Hans Wippel3b2dec22018-05-18 09:34:18 +02001288 if (new_smc->use_fallback) {
1289 smc_listen_out_connected(new_smc);
1290 return;
1291 }
1292
1293 /* check if peer is smc capable */
1294 if (!tcp_sk(newclcsock->sk)->syn_smc) {
Ursula Braun07603b22019-04-11 11:17:32 +02001295 smc_switch_to_fallback(new_smc);
Karsten Graul603cc142018-07-25 16:35:32 +02001296 new_smc->fallback_rsn = SMC_CLC_DECL_PEERNOSMC;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001297 smc_listen_out_connected(new_smc);
1298 return;
1299 }
1300
1301 /* do inband token exchange -
1302 * wait for and receive SMC Proposal CLC message
1303 */
1304 pclc = (struct smc_clc_msg_proposal *)&buf;
Karsten Graul228bae02019-04-12 12:57:28 +02001305 rc = smc_clc_wait_msg(new_smc, pclc, SMC_CLC_MAX_LEN,
1306 SMC_CLC_PROPOSAL, CLC_WAIT_TIME);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001307 if (rc)
1308 goto out_decl;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001309
1310 /* IPSec connections opt out of SMC-R optimizations */
1311 if (using_ipsec(new_smc)) {
Karsten Graul9aa68d22019-04-12 12:57:29 +02001312 rc = SMC_CLC_DECL_IPSEC;
1313 goto out_decl;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001314 }
1315
Karsten Graul59886692019-04-12 12:57:25 +02001316 /* check for matching IP prefix and subnet length */
1317 rc = smc_listen_prfx_check(new_smc, pclc);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001318 if (rc)
1319 goto out_decl;
Karsten Graul59886692019-04-12 12:57:25 +02001320
Karsten Graulfba7e8e2019-04-12 12:57:27 +02001321 /* get vlan id from IP device */
1322 if (smc_vlan_by_tcpsk(new_smc->clcsock, &ini)) {
Karsten Graul9aa68d22019-04-12 12:57:29 +02001323 rc = SMC_CLC_DECL_GETVLANERR;
1324 goto out_decl;
Karsten Graulfba7e8e2019-04-12 12:57:27 +02001325 }
1326
Hans Wippel72a36a82019-02-07 15:56:18 +01001327 mutex_lock(&smc_server_lgr_pending);
Hans Wippel3b2dec22018-05-18 09:34:18 +02001328 smc_close_init(new_smc);
1329 smc_rx_init(new_smc);
1330 smc_tx_init(new_smc);
1331
Hans Wippel41349842018-06-28 19:05:11 +02001332 /* check if ISM is available */
Karsten Graul9aa68d22019-04-12 12:57:29 +02001333 if (pclc->hdr.path == SMC_TYPE_D || pclc->hdr.path == SMC_TYPE_B) {
1334 ini.is_smcd = true; /* prepare ISM check */
1335 rc = smc_find_ism_device(new_smc, &ini);
1336 if (!rc)
Karsten Graul7a627252019-04-12 12:57:30 +02001337 rc = smc_listen_ism_init(new_smc, pclc, &ini);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001338 if (!rc)
1339 ism_supported = true;
1340 else if (pclc->hdr.path == SMC_TYPE_D)
1341 goto out_unlock; /* skip RDMA and decline */
1342 }
1343
1344 /* check if RDMA is available */
1345 if (!ism_supported) { /* SMC_TYPE_R or SMC_TYPE_B */
Karsten Graulbc36d2f2019-04-12 12:57:26 +02001346 /* prepare RDMA check */
Karsten Graulbc36d2f2019-04-12 12:57:26 +02001347 ini.is_smcd = false;
Ursula Braunca5f8d22019-10-23 15:44:06 +02001348 ini.ism_dev = NULL;
Karsten Graulbc36d2f2019-04-12 12:57:26 +02001349 ini.ib_lcl = &pclc->lcl;
Karsten Graul9aa68d22019-04-12 12:57:29 +02001350 rc = smc_find_rdma_device(new_smc, &ini);
1351 if (rc) {
1352 /* no RDMA device found */
1353 if (pclc->hdr.path == SMC_TYPE_B)
1354 /* neither ISM nor RDMA device found */
1355 rc = SMC_CLC_DECL_NOSMCDEV;
1356 goto out_unlock;
1357 }
Karsten Graul7a627252019-04-12 12:57:30 +02001358 rc = smc_listen_rdma_init(new_smc, &ini);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001359 if (rc)
1360 goto out_unlock;
Karsten Graul7a627252019-04-12 12:57:30 +02001361 rc = smc_listen_rdma_reg(new_smc, ini.cln_first_contact);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001362 if (rc)
1363 goto out_unlock;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001364 }
1365
1366 /* send SMC Accept CLC message */
Karsten Graul7a627252019-04-12 12:57:30 +02001367 rc = smc_clc_send_accept(new_smc, ini.cln_first_contact);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001368 if (rc)
1369 goto out_unlock;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001370
Hans Wippel62c71392019-02-07 15:56:17 +01001371 /* SMC-D does not need this lock any more */
1372 if (ism_supported)
Hans Wippel72a36a82019-02-07 15:56:18 +01001373 mutex_unlock(&smc_server_lgr_pending);
Hans Wippel62c71392019-02-07 15:56:17 +01001374
Hans Wippel3b2dec22018-05-18 09:34:18 +02001375 /* receive SMC Confirm CLC message */
Karsten Graul228bae02019-04-12 12:57:28 +02001376 rc = smc_clc_wait_msg(new_smc, &cclc, sizeof(cclc),
1377 SMC_CLC_CONFIRM, CLC_WAIT_TIME);
1378 if (rc) {
Hans Wippel62c71392019-02-07 15:56:17 +01001379 if (!ism_supported)
Karsten Graul9aa68d22019-04-12 12:57:29 +02001380 goto out_unlock;
1381 goto out_decl;
Hans Wippel3b2dec22018-05-18 09:34:18 +02001382 }
1383
1384 /* finish worker */
Ursula Braun1ca52fc2018-09-18 15:46:35 +02001385 if (!ism_supported) {
Karsten Graul7a627252019-04-12 12:57:30 +02001386 rc = smc_listen_rdma_finish(new_smc, &cclc,
1387 ini.cln_first_contact);
Hans Wippel72a36a82019-02-07 15:56:18 +01001388 mutex_unlock(&smc_server_lgr_pending);
Hans Wippel62c71392019-02-07 15:56:17 +01001389 if (rc)
Ursula Braun1ca52fc2018-09-18 15:46:35 +02001390 return;
1391 }
Hans Wippel3b2dec22018-05-18 09:34:18 +02001392 smc_conn_save_peer_info(new_smc, &cclc);
Hans Wippel3b2dec22018-05-18 09:34:18 +02001393 smc_listen_out_connected(new_smc);
Karsten Graul9aa68d22019-04-12 12:57:29 +02001394 return;
1395
1396out_unlock:
1397 mutex_unlock(&smc_server_lgr_pending);
1398out_decl:
Karsten Graul7a627252019-04-12 12:57:30 +02001399 smc_listen_decline(new_smc, rc, ini.cln_first_contact);
Ursula Brauna046d572017-01-09 16:55:16 +01001400}
1401
1402static void smc_tcp_listen_work(struct work_struct *work)
1403{
1404 struct smc_sock *lsmc = container_of(work, struct smc_sock,
1405 tcp_listen_work);
Ursula Braun3163c502018-01-24 10:28:12 +01001406 struct sock *lsk = &lsmc->sk;
Ursula Brauna046d572017-01-09 16:55:16 +01001407 struct smc_sock *new_smc;
1408 int rc = 0;
1409
Ursula Braun3163c502018-01-24 10:28:12 +01001410 lock_sock(lsk);
1411 while (lsk->sk_state == SMC_LISTEN) {
Ursula Brauna046d572017-01-09 16:55:16 +01001412 rc = smc_clcsock_accept(lsmc, &new_smc);
Ursula Brauna60a2b12020-09-10 18:48:20 +02001413 if (rc) /* clcsock accept queue empty or error */
Ursula Brauna046d572017-01-09 16:55:16 +01001414 goto out;
1415 if (!new_smc)
1416 continue;
1417
1418 new_smc->listen_smc = lsmc;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001419 new_smc->use_fallback = lsmc->use_fallback;
Karsten Graul603cc142018-07-25 16:35:32 +02001420 new_smc->fallback_rsn = lsmc->fallback_rsn;
Ursula Braun3163c502018-01-24 10:28:12 +01001421 sock_hold(lsk); /* sock_put in smc_listen_work */
Ursula Brauna046d572017-01-09 16:55:16 +01001422 INIT_WORK(&new_smc->smc_listen_work, smc_listen_work);
1423 smc_copy_sock_settings_to_smc(new_smc);
Ursula Braunbd58c7e2018-08-08 14:13:20 +02001424 new_smc->sk.sk_sndbuf = lsmc->sk.sk_sndbuf;
1425 new_smc->sk.sk_rcvbuf = lsmc->sk.sk_rcvbuf;
Ursula Braun51f1de72018-01-26 09:28:48 +01001426 sock_hold(&new_smc->sk); /* sock_put in passive closing */
1427 if (!schedule_work(&new_smc->smc_listen_work))
1428 sock_put(&new_smc->sk);
Ursula Brauna046d572017-01-09 16:55:16 +01001429 }
1430
1431out:
Ursula Braun3163c502018-01-24 10:28:12 +01001432 release_sock(lsk);
Ursula Brauna60a2b12020-09-10 18:48:20 +02001433 sock_put(&lsmc->sk); /* sock_hold in smc_clcsock_data_ready() */
1434}
1435
1436static void smc_clcsock_data_ready(struct sock *listen_clcsock)
1437{
1438 struct smc_sock *lsmc;
1439
1440 lsmc = (struct smc_sock *)
1441 ((uintptr_t)listen_clcsock->sk_user_data & ~SK_USER_DATA_NOCOPY);
1442 if (!lsmc)
1443 return;
1444 lsmc->clcsk_data_ready(listen_clcsock);
1445 if (lsmc->sk.sk_state == SMC_LISTEN) {
1446 sock_hold(&lsmc->sk); /* sock_put in smc_tcp_listen_work() */
1447 if (!schedule_work(&lsmc->tcp_listen_work))
1448 sock_put(&lsmc->sk);
1449 }
Ursula Brauna046d572017-01-09 16:55:16 +01001450}
1451
Ursula Braunac713872017-01-09 16:55:13 +01001452static int smc_listen(struct socket *sock, int backlog)
1453{
1454 struct sock *sk = sock->sk;
1455 struct smc_sock *smc;
1456 int rc;
1457
1458 smc = smc_sk(sk);
1459 lock_sock(sk);
1460
1461 rc = -EINVAL;
Ursula Brauncd206362019-08-02 10:47:50 +02001462 if ((sk->sk_state != SMC_INIT && sk->sk_state != SMC_LISTEN) ||
1463 smc->connect_nonblock)
Ursula Braunac713872017-01-09 16:55:13 +01001464 goto out;
1465
1466 rc = 0;
1467 if (sk->sk_state == SMC_LISTEN) {
1468 sk->sk_max_ack_backlog = backlog;
1469 goto out;
1470 }
1471 /* some socket options are handled in core, so we could not apply
1472 * them to the clc socket -- copy smc socket options to clc socket
1473 */
1474 smc_copy_sock_settings_to_clc(smc);
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001475 if (!smc->use_fallback)
1476 tcp_sk(smc->clcsock->sk)->syn_smc = 1;
Ursula Braunac713872017-01-09 16:55:13 +01001477
Ursula Brauna60a2b12020-09-10 18:48:20 +02001478 /* save original sk_data_ready function and establish
1479 * smc-specific sk_data_ready function
1480 */
1481 smc->clcsk_data_ready = smc->clcsock->sk->sk_data_ready;
1482 smc->clcsock->sk->sk_data_ready = smc_clcsock_data_ready;
1483 smc->clcsock->sk->sk_user_data =
1484 (void *)((uintptr_t)smc | SK_USER_DATA_NOCOPY);
Ursula Braunac713872017-01-09 16:55:13 +01001485 rc = kernel_listen(smc->clcsock, backlog);
1486 if (rc)
1487 goto out;
1488 sk->sk_max_ack_backlog = backlog;
1489 sk->sk_ack_backlog = 0;
1490 sk->sk_state = SMC_LISTEN;
1491
1492out:
1493 release_sock(sk);
1494 return rc;
1495}
1496
1497static int smc_accept(struct socket *sock, struct socket *new_sock,
David Howellscdfbabf2017-03-09 08:09:05 +00001498 int flags, bool kern)
Ursula Braunac713872017-01-09 16:55:13 +01001499{
Ursula Brauna046d572017-01-09 16:55:16 +01001500 struct sock *sk = sock->sk, *nsk;
1501 DECLARE_WAITQUEUE(wait, current);
Ursula Braunac713872017-01-09 16:55:13 +01001502 struct smc_sock *lsmc;
Ursula Brauna046d572017-01-09 16:55:16 +01001503 long timeo;
1504 int rc = 0;
Ursula Braunac713872017-01-09 16:55:13 +01001505
1506 lsmc = smc_sk(sk);
Ursula Braun51f1de72018-01-26 09:28:48 +01001507 sock_hold(sk); /* sock_put below */
Ursula Braunac713872017-01-09 16:55:13 +01001508 lock_sock(sk);
1509
1510 if (lsmc->sk.sk_state != SMC_LISTEN) {
1511 rc = -EINVAL;
Ursula Braunabb190f2018-04-26 17:18:23 +02001512 release_sock(sk);
Ursula Braunac713872017-01-09 16:55:13 +01001513 goto out;
1514 }
1515
Ursula Brauna046d572017-01-09 16:55:16 +01001516 /* Wait for an incoming connection */
1517 timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
1518 add_wait_queue_exclusive(sk_sleep(sk), &wait);
1519 while (!(nsk = smc_accept_dequeue(sk, new_sock))) {
1520 set_current_state(TASK_INTERRUPTIBLE);
1521 if (!timeo) {
1522 rc = -EAGAIN;
1523 break;
1524 }
1525 release_sock(sk);
1526 timeo = schedule_timeout(timeo);
1527 /* wakeup by sk_data_ready in smc_listen_work() */
1528 sched_annotate_sleep();
1529 lock_sock(sk);
1530 if (signal_pending(current)) {
1531 rc = sock_intr_errno(timeo);
1532 break;
1533 }
1534 }
1535 set_current_state(TASK_RUNNING);
1536 remove_wait_queue(sk_sleep(sk), &wait);
Ursula Braunac713872017-01-09 16:55:13 +01001537
Ursula Brauna046d572017-01-09 16:55:16 +01001538 if (!rc)
1539 rc = sock_error(nsk);
Ursula Braunabb190f2018-04-26 17:18:23 +02001540 release_sock(sk);
1541 if (rc)
1542 goto out;
1543
1544 if (lsmc->sockopt_defer_accept && !(flags & O_NONBLOCK)) {
1545 /* wait till data arrives on the socket */
1546 timeo = msecs_to_jiffies(lsmc->sockopt_defer_accept *
1547 MSEC_PER_SEC);
1548 if (smc_sk(nsk)->use_fallback) {
1549 struct sock *clcsk = smc_sk(nsk)->clcsock->sk;
1550
1551 lock_sock(clcsk);
1552 if (skb_queue_empty(&clcsk->sk_receive_queue))
1553 sk_wait_data(clcsk, &timeo, NULL);
1554 release_sock(clcsk);
1555 } else if (!atomic_read(&smc_sk(nsk)->conn.bytes_to_rcv)) {
1556 lock_sock(nsk);
Stefan Rasplb51fa1b2018-05-03 18:12:37 +02001557 smc_rx_wait(smc_sk(nsk), &timeo, smc_rx_data_available);
Ursula Braunabb190f2018-04-26 17:18:23 +02001558 release_sock(nsk);
1559 }
1560 }
Ursula Braunac713872017-01-09 16:55:13 +01001561
1562out:
Ursula Braun51f1de72018-01-26 09:28:48 +01001563 sock_put(sk); /* sock_hold above */
Ursula Braunac713872017-01-09 16:55:13 +01001564 return rc;
1565}
1566
1567static int smc_getname(struct socket *sock, struct sockaddr *addr,
Denys Vlasenko9b2c45d2018-02-12 20:00:20 +01001568 int peer)
Ursula Braunac713872017-01-09 16:55:13 +01001569{
1570 struct smc_sock *smc;
1571
Ursula Braunb38d7322017-01-09 16:55:25 +01001572 if (peer && (sock->sk->sk_state != SMC_ACTIVE) &&
1573 (sock->sk->sk_state != SMC_APPCLOSEWAIT1))
Ursula Braunac713872017-01-09 16:55:13 +01001574 return -ENOTCONN;
1575
1576 smc = smc_sk(sock->sk);
1577
Denys Vlasenko9b2c45d2018-02-12 20:00:20 +01001578 return smc->clcsock->ops->getname(smc->clcsock, addr, peer);
Ursula Braunac713872017-01-09 16:55:13 +01001579}
1580
1581static int smc_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
1582{
1583 struct sock *sk = sock->sk;
1584 struct smc_sock *smc;
1585 int rc = -EPIPE;
1586
1587 smc = smc_sk(sk);
1588 lock_sock(sk);
Ursula Braunb38d7322017-01-09 16:55:25 +01001589 if ((sk->sk_state != SMC_ACTIVE) &&
1590 (sk->sk_state != SMC_APPCLOSEWAIT1) &&
1591 (sk->sk_state != SMC_INIT))
Ursula Braunac713872017-01-09 16:55:13 +01001592 goto out;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001593
1594 if (msg->msg_flags & MSG_FASTOPEN) {
Ursula Brauncd206362019-08-02 10:47:50 +02001595 if (sk->sk_state == SMC_INIT && !smc->connect_nonblock) {
Ursula Braun07603b22019-04-11 11:17:32 +02001596 smc_switch_to_fallback(smc);
Karsten Graul603cc142018-07-25 16:35:32 +02001597 smc->fallback_rsn = SMC_CLC_DECL_OPTUNSUPP;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001598 } else {
1599 rc = -EINVAL;
1600 goto out;
1601 }
1602 }
1603
Ursula Braunac713872017-01-09 16:55:13 +01001604 if (smc->use_fallback)
1605 rc = smc->clcsock->ops->sendmsg(smc->clcsock, msg, len);
1606 else
Ursula Braune6727f32017-01-09 16:55:23 +01001607 rc = smc_tx_sendmsg(smc, msg, len);
Ursula Braunac713872017-01-09 16:55:13 +01001608out:
1609 release_sock(sk);
1610 return rc;
1611}
1612
1613static int smc_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
1614 int flags)
1615{
1616 struct sock *sk = sock->sk;
1617 struct smc_sock *smc;
1618 int rc = -ENOTCONN;
1619
1620 smc = smc_sk(sk);
1621 lock_sock(sk);
Karsten Graul51c5aba2019-01-30 18:51:04 +01001622 if (sk->sk_state == SMC_CLOSED && (sk->sk_shutdown & RCV_SHUTDOWN)) {
1623 /* socket was connected before, no more data to read */
1624 rc = 0;
1625 goto out;
1626 }
Ursula Braunb38d7322017-01-09 16:55:25 +01001627 if ((sk->sk_state == SMC_INIT) ||
1628 (sk->sk_state == SMC_LISTEN) ||
1629 (sk->sk_state == SMC_CLOSED))
Ursula Braunac713872017-01-09 16:55:13 +01001630 goto out;
1631
Ursula Braunb38d7322017-01-09 16:55:25 +01001632 if (sk->sk_state == SMC_PEERFINCLOSEWAIT) {
1633 rc = 0;
1634 goto out;
1635 }
1636
Stefan Raspl9014db22018-05-03 18:12:39 +02001637 if (smc->use_fallback) {
Ursula Braunac713872017-01-09 16:55:13 +01001638 rc = smc->clcsock->ops->recvmsg(smc->clcsock, msg, len, flags);
Stefan Raspl9014db22018-05-03 18:12:39 +02001639 } else {
1640 msg->msg_namelen = 0;
1641 rc = smc_rx_recvmsg(smc, msg, NULL, len, flags);
1642 }
Ursula Braunb38d7322017-01-09 16:55:25 +01001643
Ursula Braunac713872017-01-09 16:55:13 +01001644out:
1645 release_sock(sk);
1646 return rc;
1647}
1648
Al Viroade994f2017-07-03 00:01:49 -04001649static __poll_t smc_accept_poll(struct sock *parent)
Ursula Brauna046d572017-01-09 16:55:16 +01001650{
Ursula Braun8dce2782018-01-26 09:28:47 +01001651 struct smc_sock *isk = smc_sk(parent);
Al Viro63e24802018-02-01 10:02:53 -05001652 __poll_t mask = 0;
Ursula Brauna046d572017-01-09 16:55:16 +01001653
Ursula Braun8dce2782018-01-26 09:28:47 +01001654 spin_lock(&isk->accept_q_lock);
1655 if (!list_empty(&isk->accept_q))
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001656 mask = EPOLLIN | EPOLLRDNORM;
Ursula Braun8dce2782018-01-26 09:28:47 +01001657 spin_unlock(&isk->accept_q_lock);
Ursula Brauna046d572017-01-09 16:55:16 +01001658
Ursula Braun8dce2782018-01-26 09:28:47 +01001659 return mask;
Ursula Brauna046d572017-01-09 16:55:16 +01001660}
1661
Linus Torvaldsa11e1d42018-06-28 09:43:44 -07001662static __poll_t smc_poll(struct file *file, struct socket *sock,
1663 poll_table *wait)
Ursula Braunac713872017-01-09 16:55:13 +01001664{
1665 struct sock *sk = sock->sk;
Ursula Braunac713872017-01-09 16:55:13 +01001666 struct smc_sock *smc;
Ursula Braun50717a32019-04-12 12:57:23 +02001667 __poll_t mask = 0;
Ursula Braunac713872017-01-09 16:55:13 +01001668
Ursula Braun8dce2782018-01-26 09:28:47 +01001669 if (!sk)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001670 return EPOLLNVAL;
Ursula Braun8dce2782018-01-26 09:28:47 +01001671
Ursula Braunac713872017-01-09 16:55:13 +01001672 smc = smc_sk(sock->sk);
Ursula Braun648a5a72018-09-18 15:46:34 +02001673 if (smc->use_fallback) {
Ursula Brauna046d572017-01-09 16:55:16 +01001674 /* delegate to CLC child sock */
Linus Torvaldsa11e1d42018-06-28 09:43:44 -07001675 mask = smc->clcsock->ops->poll(file, smc->clcsock, wait);
Ursula Braun784813a2018-05-02 16:53:56 +02001676 sk->sk_err = smc->clcsock->sk->sk_err;
Ursula Braunac713872017-01-09 16:55:13 +01001677 } else {
Linus Torvalds410da1e2018-07-03 09:53:43 -07001678 if (sk->sk_state != SMC_CLOSED)
Karsten Graul89ab0662018-10-23 13:40:39 +02001679 sock_poll_wait(file, sock, wait);
Ursula Brauna046d572017-01-09 16:55:16 +01001680 if (sk->sk_err)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001681 mask |= EPOLLERR;
Ursula Braunb38d7322017-01-09 16:55:25 +01001682 if ((sk->sk_shutdown == SHUTDOWN_MASK) ||
1683 (sk->sk_state == SMC_CLOSED))
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001684 mask |= EPOLLHUP;
Ursula Braun8dce2782018-01-26 09:28:47 +01001685 if (sk->sk_state == SMC_LISTEN) {
1686 /* woken up by sk_data_ready in smc_listen_work() */
Ursula Braun50717a32019-04-12 12:57:23 +02001687 mask |= smc_accept_poll(sk);
1688 } else if (smc->use_fallback) { /* as result of connect_work()*/
1689 mask |= smc->clcsock->ops->poll(file, smc->clcsock,
1690 wait);
1691 sk->sk_err = smc->clcsock->sk->sk_err;
Ursula Braun8dce2782018-01-26 09:28:47 +01001692 } else {
Ursula Braun50717a32019-04-12 12:57:23 +02001693 if ((sk->sk_state != SMC_INIT &&
1694 atomic_read(&smc->conn.sndbuf_space)) ||
Ursula Braun8dce2782018-01-26 09:28:47 +01001695 sk->sk_shutdown & SEND_SHUTDOWN) {
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001696 mask |= EPOLLOUT | EPOLLWRNORM;
Ursula Braun8dce2782018-01-26 09:28:47 +01001697 } else {
1698 sk_set_bit(SOCKWQ_ASYNC_NOSPACE, sk);
1699 set_bit(SOCK_NOSPACE, &sk->sk_socket->flags);
1700 }
1701 if (atomic_read(&smc->conn.bytes_to_rcv))
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001702 mask |= EPOLLIN | EPOLLRDNORM;
Ursula Braun8dce2782018-01-26 09:28:47 +01001703 if (sk->sk_shutdown & RCV_SHUTDOWN)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001704 mask |= EPOLLIN | EPOLLRDNORM | EPOLLRDHUP;
Ursula Braun8dce2782018-01-26 09:28:47 +01001705 if (sk->sk_state == SMC_APPCLOSEWAIT1)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001706 mask |= EPOLLIN;
Karsten Graul71d117f2018-09-18 15:46:37 +02001707 if (smc->conn.urg_state == SMC_URG_VALID)
1708 mask |= EPOLLPRI;
Ursula Braun8dce2782018-01-26 09:28:47 +01001709 }
Ursula Braunac713872017-01-09 16:55:13 +01001710 }
1711
1712 return mask;
1713}
1714
1715static int smc_shutdown(struct socket *sock, int how)
1716{
1717 struct sock *sk = sock->sk;
1718 struct smc_sock *smc;
1719 int rc = -EINVAL;
Ursula Braunb38d7322017-01-09 16:55:25 +01001720 int rc1 = 0;
Ursula Braunac713872017-01-09 16:55:13 +01001721
1722 smc = smc_sk(sk);
1723
1724 if ((how < SHUT_RD) || (how > SHUT_RDWR))
Ursula Braunb38d7322017-01-09 16:55:25 +01001725 return rc;
Ursula Braunac713872017-01-09 16:55:13 +01001726
1727 lock_sock(sk);
1728
1729 rc = -ENOTCONN;
Ursula Brauncaa21e12018-08-08 14:13:19 +02001730 if ((sk->sk_state != SMC_ACTIVE) &&
Ursula Braunb38d7322017-01-09 16:55:25 +01001731 (sk->sk_state != SMC_PEERCLOSEWAIT1) &&
1732 (sk->sk_state != SMC_PEERCLOSEWAIT2) &&
1733 (sk->sk_state != SMC_APPCLOSEWAIT1) &&
1734 (sk->sk_state != SMC_APPCLOSEWAIT2) &&
1735 (sk->sk_state != SMC_APPFINCLOSEWAIT))
Ursula Braunac713872017-01-09 16:55:13 +01001736 goto out;
1737 if (smc->use_fallback) {
1738 rc = kernel_sock_shutdown(smc->clcsock, how);
1739 sk->sk_shutdown = smc->clcsock->sk->sk_shutdown;
1740 if (sk->sk_shutdown == SHUTDOWN_MASK)
1741 sk->sk_state = SMC_CLOSED;
Ursula Braunb38d7322017-01-09 16:55:25 +01001742 goto out;
Ursula Braunac713872017-01-09 16:55:13 +01001743 }
Ursula Braunb38d7322017-01-09 16:55:25 +01001744 switch (how) {
1745 case SHUT_RDWR: /* shutdown in both directions */
1746 rc = smc_close_active(smc);
1747 break;
1748 case SHUT_WR:
1749 rc = smc_close_shutdown_write(smc);
1750 break;
1751 case SHUT_RD:
Ursula Braun1255fcb2018-04-19 15:56:40 +02001752 rc = 0;
1753 /* nothing more to do because peer is not involved */
Ursula Braunb38d7322017-01-09 16:55:25 +01001754 break;
1755 }
Ursula Braun1255fcb2018-04-19 15:56:40 +02001756 if (smc->clcsock)
1757 rc1 = kernel_sock_shutdown(smc->clcsock, how);
Ursula Braunb38d7322017-01-09 16:55:25 +01001758 /* map sock_shutdown_cmd constants to sk_shutdown value range */
1759 sk->sk_shutdown |= how + 1;
Ursula Braunac713872017-01-09 16:55:13 +01001760
1761out:
1762 release_sock(sk);
Ursula Braunb38d7322017-01-09 16:55:25 +01001763 return rc ? rc : rc1;
Ursula Braunac713872017-01-09 16:55:13 +01001764}
1765
1766static int smc_setsockopt(struct socket *sock, int level, int optname,
Christoph Hellwiga7b75c52020-07-23 08:09:07 +02001767 sockptr_t optval, unsigned int optlen)
Ursula Braunac713872017-01-09 16:55:13 +01001768{
1769 struct sock *sk = sock->sk;
1770 struct smc_sock *smc;
Ursula Braun01d2f7e2018-04-26 17:18:22 +02001771 int val, rc;
Ursula Braunac713872017-01-09 16:55:13 +01001772
1773 smc = smc_sk(sk);
1774
1775 /* generic setsockopts reaching us here always apply to the
1776 * CLC socket
1777 */
Christoph Hellwiga44d9e72020-07-17 08:23:31 +02001778 if (unlikely(!smc->clcsock->ops->setsockopt))
1779 rc = -EOPNOTSUPP;
1780 else
1781 rc = smc->clcsock->ops->setsockopt(smc->clcsock, level, optname,
1782 optval, optlen);
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001783 if (smc->clcsock->sk->sk_err) {
1784 sk->sk_err = smc->clcsock->sk->sk_err;
1785 sk->sk_error_report(sk);
1786 }
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001787
Ursula Braun01d2f7e2018-04-26 17:18:22 +02001788 if (optlen < sizeof(int))
Wei Yongjun3dc9f552018-05-31 02:31:22 +00001789 return -EINVAL;
Christoph Hellwiga7b75c52020-07-23 08:09:07 +02001790 if (copy_from_sockptr(&val, optval, sizeof(int)))
Ursula Braunac0107e2018-07-18 15:22:50 +02001791 return -EFAULT;
Ursula Braun01d2f7e2018-04-26 17:18:22 +02001792
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001793 lock_sock(sk);
Ursula Braun86434742019-12-12 22:35:58 +01001794 if (rc || smc->use_fallback)
1795 goto out;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001796 switch (optname) {
1797 case TCP_ULP:
1798 case TCP_FASTOPEN:
1799 case TCP_FASTOPEN_CONNECT:
1800 case TCP_FASTOPEN_KEY:
1801 case TCP_FASTOPEN_NO_COOKIE:
1802 /* option not supported by SMC */
Ursula Braun8204df72019-11-15 12:39:30 +01001803 if (sk->sk_state == SMC_INIT && !smc->connect_nonblock) {
Ursula Braun07603b22019-04-11 11:17:32 +02001804 smc_switch_to_fallback(smc);
Karsten Graul603cc142018-07-25 16:35:32 +02001805 smc->fallback_rsn = SMC_CLC_DECL_OPTUNSUPP;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001806 } else {
Ursula Braun86434742019-12-12 22:35:58 +01001807 rc = -EINVAL;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001808 }
1809 break;
Ursula Braun01d2f7e2018-04-26 17:18:22 +02001810 case TCP_NODELAY:
Ursula Braunf9cedf12019-08-02 10:16:38 +02001811 if (sk->sk_state != SMC_INIT &&
1812 sk->sk_state != SMC_LISTEN &&
1813 sk->sk_state != SMC_CLOSED) {
Ursula Braun86434742019-12-12 22:35:58 +01001814 if (val)
Ursula Braun01d2f7e2018-04-26 17:18:22 +02001815 mod_delayed_work(system_wq, &smc->conn.tx_work,
1816 0);
1817 }
1818 break;
1819 case TCP_CORK:
Ursula Braunf9cedf12019-08-02 10:16:38 +02001820 if (sk->sk_state != SMC_INIT &&
1821 sk->sk_state != SMC_LISTEN &&
1822 sk->sk_state != SMC_CLOSED) {
Ursula Braun86434742019-12-12 22:35:58 +01001823 if (!val)
Ursula Braun01d2f7e2018-04-26 17:18:22 +02001824 mod_delayed_work(system_wq, &smc->conn.tx_work,
1825 0);
1826 }
1827 break;
Ursula Braunabb190f2018-04-26 17:18:23 +02001828 case TCP_DEFER_ACCEPT:
1829 smc->sockopt_defer_accept = val;
1830 break;
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001831 default:
1832 break;
1833 }
Ursula Braun86434742019-12-12 22:35:58 +01001834out:
Ursula Braunee9dfbe2018-04-26 17:18:21 +02001835 release_sock(sk);
1836
1837 return rc;
Ursula Braunac713872017-01-09 16:55:13 +01001838}
1839
1840static int smc_getsockopt(struct socket *sock, int level, int optname,
1841 char __user *optval, int __user *optlen)
1842{
1843 struct smc_sock *smc;
1844
1845 smc = smc_sk(sock->sk);
1846 /* socket options apply to the CLC socket */
Christoph Hellwiga44d9e72020-07-17 08:23:31 +02001847 if (unlikely(!smc->clcsock->ops->getsockopt))
1848 return -EOPNOTSUPP;
Ursula Braunac713872017-01-09 16:55:13 +01001849 return smc->clcsock->ops->getsockopt(smc->clcsock, level, optname,
1850 optval, optlen);
1851}
1852
1853static int smc_ioctl(struct socket *sock, unsigned int cmd,
1854 unsigned long arg)
1855{
Stefan Rasplde8474e2018-05-23 16:38:11 +02001856 union smc_host_cursor cons, urg;
1857 struct smc_connection *conn;
Ursula Braunac713872017-01-09 16:55:13 +01001858 struct smc_sock *smc;
Ursula Braun9b67e262018-05-02 16:56:46 +02001859 int answ;
Ursula Braunac713872017-01-09 16:55:13 +01001860
1861 smc = smc_sk(sock->sk);
Stefan Rasplde8474e2018-05-23 16:38:11 +02001862 conn = &smc->conn;
Ursula Braun1992d992018-07-16 13:56:52 +02001863 lock_sock(&smc->sk);
Ursula Braun7311d662018-08-08 14:13:21 +02001864 if (smc->use_fallback) {
1865 if (!smc->clcsock) {
1866 release_sock(&smc->sk);
1867 return -EBADF;
1868 }
1869 answ = smc->clcsock->ops->ioctl(smc->clcsock, cmd, arg);
1870 release_sock(&smc->sk);
1871 return answ;
1872 }
Ursula Braun9b67e262018-05-02 16:56:46 +02001873 switch (cmd) {
1874 case SIOCINQ: /* same as FIONREAD */
Ursula Braun1992d992018-07-16 13:56:52 +02001875 if (smc->sk.sk_state == SMC_LISTEN) {
1876 release_sock(&smc->sk);
Ursula Braun9b67e262018-05-02 16:56:46 +02001877 return -EINVAL;
Ursula Braun1992d992018-07-16 13:56:52 +02001878 }
Ursula Braun2351abe2018-05-23 16:38:09 +02001879 if (smc->sk.sk_state == SMC_INIT ||
1880 smc->sk.sk_state == SMC_CLOSED)
1881 answ = 0;
1882 else
1883 answ = atomic_read(&smc->conn.bytes_to_rcv);
Ursula Braun9b67e262018-05-02 16:56:46 +02001884 break;
1885 case SIOCOUTQ:
1886 /* output queue size (not send + not acked) */
Ursula Braun1992d992018-07-16 13:56:52 +02001887 if (smc->sk.sk_state == SMC_LISTEN) {
1888 release_sock(&smc->sk);
Ursula Braun9b67e262018-05-02 16:56:46 +02001889 return -EINVAL;
Ursula Braun1992d992018-07-16 13:56:52 +02001890 }
Ursula Braun2351abe2018-05-23 16:38:09 +02001891 if (smc->sk.sk_state == SMC_INIT ||
1892 smc->sk.sk_state == SMC_CLOSED)
1893 answ = 0;
1894 else
1895 answ = smc->conn.sndbuf_desc->len -
Ursula Braun9b67e262018-05-02 16:56:46 +02001896 atomic_read(&smc->conn.sndbuf_space);
1897 break;
1898 case SIOCOUTQNSD:
1899 /* output queue size (not send only) */
Ursula Braun1992d992018-07-16 13:56:52 +02001900 if (smc->sk.sk_state == SMC_LISTEN) {
1901 release_sock(&smc->sk);
Ursula Braun9b67e262018-05-02 16:56:46 +02001902 return -EINVAL;
Ursula Braun1992d992018-07-16 13:56:52 +02001903 }
Ursula Braun2351abe2018-05-23 16:38:09 +02001904 if (smc->sk.sk_state == SMC_INIT ||
1905 smc->sk.sk_state == SMC_CLOSED)
1906 answ = 0;
1907 else
1908 answ = smc_tx_prepared_sends(&smc->conn);
Ursula Braun9b67e262018-05-02 16:56:46 +02001909 break;
Stefan Rasplde8474e2018-05-23 16:38:11 +02001910 case SIOCATMARK:
Ursula Braun1992d992018-07-16 13:56:52 +02001911 if (smc->sk.sk_state == SMC_LISTEN) {
1912 release_sock(&smc->sk);
Stefan Rasplde8474e2018-05-23 16:38:11 +02001913 return -EINVAL;
Ursula Braun1992d992018-07-16 13:56:52 +02001914 }
Stefan Rasplde8474e2018-05-23 16:38:11 +02001915 if (smc->sk.sk_state == SMC_INIT ||
1916 smc->sk.sk_state == SMC_CLOSED) {
1917 answ = 0;
1918 } else {
Stefan Rasplbac6de72018-07-23 13:53:09 +02001919 smc_curs_copy(&cons, &conn->local_tx_ctrl.cons, conn);
1920 smc_curs_copy(&urg, &conn->urg_curs, conn);
Stefan Rasplde8474e2018-05-23 16:38:11 +02001921 answ = smc_curs_diff(conn->rmb_desc->len,
1922 &cons, &urg) == 1;
1923 }
1924 break;
Ursula Braun9b67e262018-05-02 16:56:46 +02001925 default:
Ursula Braun1992d992018-07-16 13:56:52 +02001926 release_sock(&smc->sk);
Ursula Braun9b67e262018-05-02 16:56:46 +02001927 return -ENOIOCTLCMD;
1928 }
Ursula Braun1992d992018-07-16 13:56:52 +02001929 release_sock(&smc->sk);
Ursula Braun9b67e262018-05-02 16:56:46 +02001930
1931 return put_user(answ, (int __user *)arg);
Ursula Braunac713872017-01-09 16:55:13 +01001932}
1933
1934static ssize_t smc_sendpage(struct socket *sock, struct page *page,
1935 int offset, size_t size, int flags)
1936{
1937 struct sock *sk = sock->sk;
1938 struct smc_sock *smc;
1939 int rc = -EPIPE;
1940
1941 smc = smc_sk(sk);
1942 lock_sock(sk);
Stefan Rasplbda27ff2018-05-03 17:57:39 +02001943 if (sk->sk_state != SMC_ACTIVE) {
1944 release_sock(sk);
Ursula Braunac713872017-01-09 16:55:13 +01001945 goto out;
Stefan Rasplbda27ff2018-05-03 17:57:39 +02001946 }
1947 release_sock(sk);
Ursula Braunac713872017-01-09 16:55:13 +01001948 if (smc->use_fallback)
1949 rc = kernel_sendpage(smc->clcsock, page, offset,
1950 size, flags);
1951 else
1952 rc = sock_no_sendpage(sock, page, offset, size, flags);
1953
1954out:
Ursula Braunac713872017-01-09 16:55:13 +01001955 return rc;
1956}
1957
Stefan Raspl9014db22018-05-03 18:12:39 +02001958/* Map the affected portions of the rmbe into an spd, note the number of bytes
1959 * to splice in conn->splice_pending, and press 'go'. Delays consumer cursor
1960 * updates till whenever a respective page has been fully processed.
1961 * Note that subsequent recv() calls have to wait till all splice() processing
1962 * completed.
1963 */
Ursula Braunac713872017-01-09 16:55:13 +01001964static ssize_t smc_splice_read(struct socket *sock, loff_t *ppos,
1965 struct pipe_inode_info *pipe, size_t len,
Stefan Raspl9014db22018-05-03 18:12:39 +02001966 unsigned int flags)
Ursula Braunac713872017-01-09 16:55:13 +01001967{
1968 struct sock *sk = sock->sk;
1969 struct smc_sock *smc;
1970 int rc = -ENOTCONN;
1971
1972 smc = smc_sk(sk);
1973 lock_sock(sk);
Karsten Graul51c5aba2019-01-30 18:51:04 +01001974 if (sk->sk_state == SMC_CLOSED && (sk->sk_shutdown & RCV_SHUTDOWN)) {
1975 /* socket was connected before, no more data to read */
1976 rc = 0;
1977 goto out;
1978 }
Stefan Raspl9014db22018-05-03 18:12:39 +02001979 if (sk->sk_state == SMC_INIT ||
1980 sk->sk_state == SMC_LISTEN ||
1981 sk->sk_state == SMC_CLOSED)
Ursula Braunac713872017-01-09 16:55:13 +01001982 goto out;
Stefan Raspl9014db22018-05-03 18:12:39 +02001983
1984 if (sk->sk_state == SMC_PEERFINCLOSEWAIT) {
1985 rc = 0;
1986 goto out;
1987 }
1988
Ursula Braunac713872017-01-09 16:55:13 +01001989 if (smc->use_fallback) {
1990 rc = smc->clcsock->ops->splice_read(smc->clcsock, ppos,
1991 pipe, len, flags);
1992 } else {
Stefan Raspl9014db22018-05-03 18:12:39 +02001993 if (*ppos) {
1994 rc = -ESPIPE;
1995 goto out;
1996 }
1997 if (flags & SPLICE_F_NONBLOCK)
1998 flags = MSG_DONTWAIT;
1999 else
2000 flags = 0;
2001 rc = smc_rx_recvmsg(smc, NULL, pipe, len, flags);
Ursula Braunac713872017-01-09 16:55:13 +01002002 }
2003out:
2004 release_sock(sk);
Stefan Raspl9014db22018-05-03 18:12:39 +02002005
Ursula Braunac713872017-01-09 16:55:13 +01002006 return rc;
2007}
2008
2009/* must look like tcp */
2010static const struct proto_ops smc_sock_ops = {
2011 .family = PF_SMC,
2012 .owner = THIS_MODULE,
2013 .release = smc_release,
2014 .bind = smc_bind,
2015 .connect = smc_connect,
2016 .socketpair = sock_no_socketpair,
2017 .accept = smc_accept,
2018 .getname = smc_getname,
Linus Torvaldsa11e1d42018-06-28 09:43:44 -07002019 .poll = smc_poll,
Ursula Braunac713872017-01-09 16:55:13 +01002020 .ioctl = smc_ioctl,
2021 .listen = smc_listen,
2022 .shutdown = smc_shutdown,
2023 .setsockopt = smc_setsockopt,
2024 .getsockopt = smc_getsockopt,
2025 .sendmsg = smc_sendmsg,
2026 .recvmsg = smc_recvmsg,
2027 .mmap = sock_no_mmap,
2028 .sendpage = smc_sendpage,
2029 .splice_read = smc_splice_read,
2030};
2031
2032static int smc_create(struct net *net, struct socket *sock, int protocol,
2033 int kern)
2034{
Karsten Graulaaa4d332018-03-16 15:06:41 +01002035 int family = (protocol == SMCPROTO_SMC6) ? PF_INET6 : PF_INET;
Ursula Braunac713872017-01-09 16:55:13 +01002036 struct smc_sock *smc;
2037 struct sock *sk;
2038 int rc;
2039
2040 rc = -ESOCKTNOSUPPORT;
2041 if (sock->type != SOCK_STREAM)
2042 goto out;
2043
2044 rc = -EPROTONOSUPPORT;
Karsten Graulaaa4d332018-03-16 15:06:41 +01002045 if (protocol != SMCPROTO_SMC && protocol != SMCPROTO_SMC6)
Ursula Braunac713872017-01-09 16:55:13 +01002046 goto out;
2047
2048 rc = -ENOBUFS;
2049 sock->ops = &smc_sock_ops;
Karsten Graulaaa4d332018-03-16 15:06:41 +01002050 sk = smc_sock_alloc(net, sock, protocol);
Ursula Braunac713872017-01-09 16:55:13 +01002051 if (!sk)
2052 goto out;
2053
2054 /* create internal TCP socket for CLC handshake and fallback */
2055 smc = smc_sk(sk);
Ursula Brauna046d572017-01-09 16:55:16 +01002056 smc->use_fallback = false; /* assume rdma capability first */
Karsten Graul603cc142018-07-25 16:35:32 +02002057 smc->fallback_rsn = 0;
Karsten Graulaaa4d332018-03-16 15:06:41 +01002058 rc = sock_create_kern(net, family, SOCK_STREAM, IPPROTO_TCP,
2059 &smc->clcsock);
Davide Carattia5dcb732018-02-28 12:44:09 +01002060 if (rc) {
Ursula Braunac713872017-01-09 16:55:13 +01002061 sk_common_release(sk);
Davide Carattia5dcb732018-02-28 12:44:09 +01002062 goto out;
2063 }
Ursula Brauncd6851f2017-01-09 16:55:18 +01002064 smc->sk.sk_sndbuf = max(smc->clcsock->sk->sk_sndbuf, SMC_BUF_MIN_SIZE);
2065 smc->sk.sk_rcvbuf = max(smc->clcsock->sk->sk_rcvbuf, SMC_BUF_MIN_SIZE);
Ursula Braunac713872017-01-09 16:55:13 +01002066
2067out:
2068 return rc;
2069}
2070
2071static const struct net_proto_family smc_sock_family_ops = {
2072 .family = PF_SMC,
2073 .owner = THIS_MODULE,
2074 .create = smc_create,
2075};
2076
Hans Wippel64e28b52019-02-21 13:01:02 +01002077unsigned int smc_net_id;
2078
2079static __net_init int smc_net_init(struct net *net)
2080{
2081 return smc_pnet_net_init(net);
2082}
2083
2084static void __net_exit smc_net_exit(struct net *net)
2085{
2086 smc_pnet_net_exit(net);
2087}
2088
2089static struct pernet_operations smc_net_ops = {
2090 .init = smc_net_init,
2091 .exit = smc_net_exit,
2092 .id = &smc_net_id,
2093 .size = sizeof(struct smc_net),
2094};
2095
Ursula Braunac713872017-01-09 16:55:13 +01002096static int __init smc_init(void)
2097{
2098 int rc;
2099
Hans Wippel64e28b52019-02-21 13:01:02 +01002100 rc = register_pernet_subsys(&smc_net_ops);
2101 if (rc)
2102 return rc;
2103
Thomas Richter6812baa2017-01-09 16:55:15 +01002104 rc = smc_pnet_init();
2105 if (rc)
YueHaibing8c33bf12019-06-26 17:47:50 +02002106 goto out_pernet_subsys;
Thomas Richter6812baa2017-01-09 16:55:15 +01002107
Ursula Braun6dabd402019-11-16 17:47:29 +01002108 rc = smc_core_init();
2109 if (rc) {
2110 pr_err("%s: smc_core_init fails with %d\n", __func__, rc);
2111 goto out_pnet;
2112 }
2113
Ursula Braun9bf9abe2017-01-09 16:55:21 +01002114 rc = smc_llc_init();
2115 if (rc) {
2116 pr_err("%s: smc_llc_init fails with %d\n", __func__, rc);
Ursula Braun6dabd402019-11-16 17:47:29 +01002117 goto out_core;
Ursula Braun9bf9abe2017-01-09 16:55:21 +01002118 }
2119
Ursula Braun5f083182017-01-09 16:55:22 +01002120 rc = smc_cdc_init();
2121 if (rc) {
2122 pr_err("%s: smc_cdc_init fails with %d\n", __func__, rc);
Ursula Braun6dabd402019-11-16 17:47:29 +01002123 goto out_core;
Ursula Braun5f083182017-01-09 16:55:22 +01002124 }
2125
Ursula Braunac713872017-01-09 16:55:13 +01002126 rc = proto_register(&smc_proto, 1);
2127 if (rc) {
Karsten Graulaaa4d332018-03-16 15:06:41 +01002128 pr_err("%s: proto_register(v4) fails with %d\n", __func__, rc);
Ursula Braun6dabd402019-11-16 17:47:29 +01002129 goto out_core;
Ursula Braunac713872017-01-09 16:55:13 +01002130 }
2131
Karsten Graulaaa4d332018-03-16 15:06:41 +01002132 rc = proto_register(&smc_proto6, 1);
2133 if (rc) {
2134 pr_err("%s: proto_register(v6) fails with %d\n", __func__, rc);
2135 goto out_proto;
2136 }
2137
Ursula Braunac713872017-01-09 16:55:13 +01002138 rc = sock_register(&smc_sock_family_ops);
2139 if (rc) {
2140 pr_err("%s: sock_register fails with %d\n", __func__, rc);
Karsten Graulaaa4d332018-03-16 15:06:41 +01002141 goto out_proto6;
Ursula Braunac713872017-01-09 16:55:13 +01002142 }
Ursula Braunf16a7dd2017-01-09 16:55:26 +01002143 INIT_HLIST_HEAD(&smc_v4_hashinfo.ht);
Karsten Graulaaa4d332018-03-16 15:06:41 +01002144 INIT_HLIST_HEAD(&smc_v6_hashinfo.ht);
Ursula Braunac713872017-01-09 16:55:13 +01002145
Ursula Brauna4cf0442017-01-09 16:55:14 +01002146 rc = smc_ib_register_client();
2147 if (rc) {
2148 pr_err("%s: ib_register fails with %d\n", __func__, rc);
2149 goto out_sock;
2150 }
2151
Ursula Braunc5c1cc92017-10-25 11:01:46 +02002152 static_branch_enable(&tcp_have_smc);
Ursula Braunac713872017-01-09 16:55:13 +01002153 return 0;
2154
Ursula Brauna4cf0442017-01-09 16:55:14 +01002155out_sock:
2156 sock_unregister(PF_SMC);
Karsten Graulaaa4d332018-03-16 15:06:41 +01002157out_proto6:
2158 proto_unregister(&smc_proto6);
Ursula Braunac713872017-01-09 16:55:13 +01002159out_proto:
2160 proto_unregister(&smc_proto);
Ursula Braun6dabd402019-11-16 17:47:29 +01002161out_core:
2162 smc_core_exit();
Thomas Richter6812baa2017-01-09 16:55:15 +01002163out_pnet:
2164 smc_pnet_exit();
YueHaibing8c33bf12019-06-26 17:47:50 +02002165out_pernet_subsys:
2166 unregister_pernet_subsys(&smc_net_ops);
2167
Ursula Braunac713872017-01-09 16:55:13 +01002168 return rc;
2169}
2170
2171static void __exit smc_exit(void)
2172{
Ursula Braunc5c1cc92017-10-25 11:01:46 +02002173 static_branch_disable(&tcp_have_smc);
Ursula Braunac713872017-01-09 16:55:13 +01002174 sock_unregister(PF_SMC);
Ursula Braun6dabd402019-11-16 17:47:29 +01002175 smc_core_exit();
2176 smc_ib_unregister_client();
Karsten Graulaaa4d332018-03-16 15:06:41 +01002177 proto_unregister(&smc_proto6);
Ursula Braunac713872017-01-09 16:55:13 +01002178 proto_unregister(&smc_proto);
Thomas Richter6812baa2017-01-09 16:55:15 +01002179 smc_pnet_exit();
Hans Wippel64e28b52019-02-21 13:01:02 +01002180 unregister_pernet_subsys(&smc_net_ops);
Ursula Braun4ead9c92019-11-16 17:47:31 +01002181 rcu_barrier();
Ursula Braunac713872017-01-09 16:55:13 +01002182}
2183
2184module_init(smc_init);
2185module_exit(smc_exit);
2186
2187MODULE_AUTHOR("Ursula Braun <ubraun@linux.vnet.ibm.com>");
2188MODULE_DESCRIPTION("smc socket address family");
2189MODULE_LICENSE("GPL");
2190MODULE_ALIAS_NETPROTO(PF_SMC);