blob: e5c63950fc284be027f41d619544bc04306864a4 [file] [log] [blame]
Ursula Braun0cfdd8f2017-01-09 16:55:17 +01001/*
2 * Shared Memory Communications over RDMA (SMC-R) and RoCE
3 *
4 * Basic Transport Functions exploiting Infiniband API
5 *
6 * Copyright IBM Corp. 2016
7 *
8 * Author(s): Ursula Braun <ubraun@linux.vnet.ibm.com>
9 */
10
11#include <linux/socket.h>
12#include <linux/if_vlan.h>
13#include <linux/random.h>
14#include <linux/workqueue.h>
15#include <net/tcp.h>
16#include <net/sock.h>
17#include <rdma/ib_verbs.h>
18
19#include "smc.h"
20#include "smc_clc.h"
21#include "smc_core.h"
22#include "smc_ib.h"
Ursula Braunf38ba1792017-01-09 16:55:19 +010023#include "smc_wr.h"
Ursula Braun9bf9abe2017-01-09 16:55:21 +010024#include "smc_llc.h"
Ursula Braun5f083182017-01-09 16:55:22 +010025#include "smc_cdc.h"
Ursula Braun0cfdd8f2017-01-09 16:55:17 +010026
Ursula Braun9bf9abe2017-01-09 16:55:21 +010027#define SMC_LGR_NUM_INCR 256
Ursula Braun0cfdd8f2017-01-09 16:55:17 +010028#define SMC_LGR_FREE_DELAY (600 * HZ)
29
Ursula Braun9bf9abe2017-01-09 16:55:21 +010030static u32 smc_lgr_num; /* unique link group number */
31
Ursula Braun0cfdd8f2017-01-09 16:55:17 +010032/* Register connection's alert token in our lookup structure.
33 * To use rbtrees we have to implement our own insert core.
34 * Requires @conns_lock
35 * @smc connection to register
36 * Returns 0 on success, != otherwise.
37 */
38static void smc_lgr_add_alert_token(struct smc_connection *conn)
39{
40 struct rb_node **link, *parent = NULL;
41 u32 token = conn->alert_token_local;
42
43 link = &conn->lgr->conns_all.rb_node;
44 while (*link) {
45 struct smc_connection *cur = rb_entry(*link,
46 struct smc_connection, alert_node);
47
48 parent = *link;
49 if (cur->alert_token_local > token)
50 link = &parent->rb_left;
51 else
52 link = &parent->rb_right;
53 }
54 /* Put the new node there */
55 rb_link_node(&conn->alert_node, parent, link);
56 rb_insert_color(&conn->alert_node, &conn->lgr->conns_all);
57}
58
59/* Register connection in link group by assigning an alert token
60 * registered in a search tree.
61 * Requires @conns_lock
62 * Note that '0' is a reserved value and not assigned.
63 */
64static void smc_lgr_register_conn(struct smc_connection *conn)
65{
66 struct smc_sock *smc = container_of(conn, struct smc_sock, conn);
67 static atomic_t nexttoken = ATOMIC_INIT(0);
68
69 /* find a new alert_token_local value not yet used by some connection
70 * in this link group
71 */
72 sock_hold(&smc->sk); /* sock_put in smc_lgr_unregister_conn() */
73 while (!conn->alert_token_local) {
74 conn->alert_token_local = atomic_inc_return(&nexttoken);
75 if (smc_lgr_find_conn(conn->alert_token_local, conn->lgr))
76 conn->alert_token_local = 0;
77 }
78 smc_lgr_add_alert_token(conn);
79 conn->lgr->conns_num++;
80}
81
82/* Unregister connection and reset the alert token of the given connection<
83 */
84static void __smc_lgr_unregister_conn(struct smc_connection *conn)
85{
86 struct smc_sock *smc = container_of(conn, struct smc_sock, conn);
87 struct smc_link_group *lgr = conn->lgr;
88
89 rb_erase(&conn->alert_node, &lgr->conns_all);
90 lgr->conns_num--;
91 conn->alert_token_local = 0;
92 conn->lgr = NULL;
93 sock_put(&smc->sk); /* sock_hold in smc_lgr_register_conn() */
94}
95
96/* Unregister connection and trigger lgr freeing if applicable
97 */
98static void smc_lgr_unregister_conn(struct smc_connection *conn)
99{
100 struct smc_link_group *lgr = conn->lgr;
101 int reduced = 0;
102
103 write_lock_bh(&lgr->conns_lock);
104 if (conn->alert_token_local) {
105 reduced = 1;
106 __smc_lgr_unregister_conn(conn);
107 }
108 write_unlock_bh(&lgr->conns_lock);
109 if (reduced && !lgr->conns_num)
110 schedule_delayed_work(&lgr->free_work, SMC_LGR_FREE_DELAY);
111}
112
113static void smc_lgr_free_work(struct work_struct *work)
114{
115 struct smc_link_group *lgr = container_of(to_delayed_work(work),
116 struct smc_link_group,
117 free_work);
118 bool conns;
119
120 spin_lock_bh(&smc_lgr_list.lock);
121 read_lock_bh(&lgr->conns_lock);
122 conns = RB_EMPTY_ROOT(&lgr->conns_all);
123 read_unlock_bh(&lgr->conns_lock);
124 if (!conns) { /* number of lgr connections is no longer zero */
125 spin_unlock_bh(&smc_lgr_list.lock);
126 return;
127 }
128 list_del_init(&lgr->list); /* remove from smc_lgr_list */
129 spin_unlock_bh(&smc_lgr_list.lock);
130 smc_lgr_free(lgr);
131}
132
133/* create a new SMC link group */
134static int smc_lgr_create(struct smc_sock *smc, __be32 peer_in_addr,
135 struct smc_ib_device *smcibdev, u8 ibport,
136 char *peer_systemid, unsigned short vlan_id)
137{
138 struct smc_link_group *lgr;
139 struct smc_link *lnk;
140 u8 rndvec[3];
141 int rc = 0;
Ursula Brauncd6851f2017-01-09 16:55:18 +0100142 int i;
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100143
144 lgr = kzalloc(sizeof(*lgr), GFP_KERNEL);
145 if (!lgr) {
146 rc = -ENOMEM;
147 goto out;
148 }
149 lgr->role = smc->listen_smc ? SMC_SERV : SMC_CLNT;
150 lgr->sync_err = false;
151 lgr->daddr = peer_in_addr;
152 memcpy(lgr->peer_systemid, peer_systemid, SMC_SYSTEMID_LEN);
153 lgr->vlan_id = vlan_id;
Ursula Brauncd6851f2017-01-09 16:55:18 +0100154 rwlock_init(&lgr->sndbufs_lock);
155 rwlock_init(&lgr->rmbs_lock);
156 for (i = 0; i < SMC_RMBE_SIZES; i++) {
157 INIT_LIST_HEAD(&lgr->sndbufs[i]);
158 INIT_LIST_HEAD(&lgr->rmbs[i]);
159 }
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100160 smc_lgr_num += SMC_LGR_NUM_INCR;
161 memcpy(&lgr->id, (u8 *)&smc_lgr_num, SMC_LGR_ID_SIZE);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100162 INIT_DELAYED_WORK(&lgr->free_work, smc_lgr_free_work);
163 lgr->conns_all = RB_ROOT;
164
165 lnk = &lgr->lnk[SMC_SINGLE_LINK];
166 /* initialize link */
167 lnk->smcibdev = smcibdev;
168 lnk->ibport = ibport;
169 lnk->path_mtu = smcibdev->pattr[ibport - 1].active_mtu;
Ursula Braunbd4ad572017-01-09 16:55:20 +0100170 if (!smcibdev->initialized)
171 smc_ib_setup_per_ibdev(smcibdev);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100172 get_random_bytes(rndvec, sizeof(rndvec));
173 lnk->psn_initial = rndvec[0] + (rndvec[1] << 8) + (rndvec[2] << 16);
Ursula Braunf38ba1792017-01-09 16:55:19 +0100174 rc = smc_wr_alloc_link_mem(lnk);
175 if (rc)
176 goto free_lgr;
177 init_waitqueue_head(&lnk->wr_tx_wait);
Ursula Braunbd4ad572017-01-09 16:55:20 +0100178 rc = smc_ib_create_protection_domain(lnk);
179 if (rc)
180 goto free_link_mem;
181 rc = smc_ib_create_queue_pair(lnk);
182 if (rc)
183 goto dealloc_pd;
184 rc = smc_wr_create_link(lnk);
185 if (rc)
186 goto destroy_qp;
Ursula Braun9bf9abe2017-01-09 16:55:21 +0100187 init_completion(&lnk->llc_confirm);
188 init_completion(&lnk->llc_confirm_resp);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100189
190 smc->conn.lgr = lgr;
191 rwlock_init(&lgr->conns_lock);
192 spin_lock_bh(&smc_lgr_list.lock);
193 list_add(&lgr->list, &smc_lgr_list.list);
194 spin_unlock_bh(&smc_lgr_list.lock);
Ursula Braunf38ba1792017-01-09 16:55:19 +0100195 return 0;
196
Ursula Braunbd4ad572017-01-09 16:55:20 +0100197destroy_qp:
198 smc_ib_destroy_queue_pair(lnk);
199dealloc_pd:
200 smc_ib_dealloc_protection_domain(lnk);
201free_link_mem:
202 smc_wr_free_link_mem(lnk);
Ursula Braunf38ba1792017-01-09 16:55:19 +0100203free_lgr:
204 kfree(lgr);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100205out:
206 return rc;
207}
208
Ursula Brauncd6851f2017-01-09 16:55:18 +0100209static void smc_sndbuf_unuse(struct smc_connection *conn)
210{
211 if (conn->sndbuf_desc) {
212 conn->sndbuf_desc->used = 0;
213 conn->sndbuf_size = 0;
214 }
215}
216
217static void smc_rmb_unuse(struct smc_connection *conn)
218{
219 if (conn->rmb_desc) {
220 conn->rmb_desc->used = 0;
221 conn->rmbe_size = 0;
222 }
223}
224
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100225/* remove a finished connection from its link group */
226void smc_conn_free(struct smc_connection *conn)
227{
228 struct smc_link_group *lgr = conn->lgr;
229
230 if (!lgr)
231 return;
Ursula Braun5f083182017-01-09 16:55:22 +0100232 smc_cdc_tx_dismiss_slots(conn);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100233 smc_lgr_unregister_conn(conn);
Ursula Brauncd6851f2017-01-09 16:55:18 +0100234 smc_rmb_unuse(conn);
235 smc_sndbuf_unuse(conn);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100236}
237
238static void smc_link_clear(struct smc_link *lnk)
239{
240 lnk->peer_qpn = 0;
Ursula Braunbd4ad572017-01-09 16:55:20 +0100241 smc_ib_modify_qp_reset(lnk);
Ursula Braunf38ba1792017-01-09 16:55:19 +0100242 smc_wr_free_link(lnk);
Ursula Braunbd4ad572017-01-09 16:55:20 +0100243 smc_ib_destroy_queue_pair(lnk);
244 smc_ib_dealloc_protection_domain(lnk);
Ursula Braunf38ba1792017-01-09 16:55:19 +0100245 smc_wr_free_link_mem(lnk);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100246}
247
Ursula Brauncd6851f2017-01-09 16:55:18 +0100248static void smc_lgr_free_sndbufs(struct smc_link_group *lgr)
249{
250 struct smc_buf_desc *sndbuf_desc, *bf_desc;
251 int i;
252
253 for (i = 0; i < SMC_RMBE_SIZES; i++) {
254 list_for_each_entry_safe(sndbuf_desc, bf_desc, &lgr->sndbufs[i],
255 list) {
Ursula Braunbd4ad572017-01-09 16:55:20 +0100256 list_del(&sndbuf_desc->list);
257 smc_ib_buf_unmap(lgr->lnk[SMC_SINGLE_LINK].smcibdev,
258 smc_uncompress_bufsize(i),
259 sndbuf_desc, DMA_TO_DEVICE);
Ursula Brauncd6851f2017-01-09 16:55:18 +0100260 kfree(sndbuf_desc->cpu_addr);
261 kfree(sndbuf_desc);
262 }
263 }
264}
265
266static void smc_lgr_free_rmbs(struct smc_link_group *lgr)
267{
268 struct smc_buf_desc *rmb_desc, *bf_desc;
Ursula Braunbd4ad572017-01-09 16:55:20 +0100269 struct smc_link *lnk = &lgr->lnk[SMC_SINGLE_LINK];
Ursula Brauncd6851f2017-01-09 16:55:18 +0100270 int i;
271
272 for (i = 0; i < SMC_RMBE_SIZES; i++) {
273 list_for_each_entry_safe(rmb_desc, bf_desc, &lgr->rmbs[i],
274 list) {
Ursula Braunbd4ad572017-01-09 16:55:20 +0100275 list_del(&rmb_desc->list);
276 smc_ib_buf_unmap(lnk->smcibdev,
277 smc_uncompress_bufsize(i),
278 rmb_desc, DMA_FROM_DEVICE);
Ursula Brauncd6851f2017-01-09 16:55:18 +0100279 kfree(rmb_desc->cpu_addr);
280 kfree(rmb_desc);
281 }
282 }
283}
284
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100285/* remove a link group */
286void smc_lgr_free(struct smc_link_group *lgr)
287{
Ursula Brauncd6851f2017-01-09 16:55:18 +0100288 smc_lgr_free_rmbs(lgr);
289 smc_lgr_free_sndbufs(lgr);
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100290 smc_link_clear(&lgr->lnk[SMC_SINGLE_LINK]);
291 kfree(lgr);
292}
293
294/* terminate linkgroup abnormally */
295void smc_lgr_terminate(struct smc_link_group *lgr)
296{
297 struct smc_connection *conn;
298 struct rb_node *node;
299
300 spin_lock_bh(&smc_lgr_list.lock);
301 if (list_empty(&lgr->list)) {
302 /* termination already triggered */
303 spin_unlock_bh(&smc_lgr_list.lock);
304 return;
305 }
306 /* do not use this link group for new connections */
307 list_del_init(&lgr->list);
308 spin_unlock_bh(&smc_lgr_list.lock);
309
310 write_lock_bh(&lgr->conns_lock);
311 node = rb_first(&lgr->conns_all);
312 while (node) {
313 conn = rb_entry(node, struct smc_connection, alert_node);
314 __smc_lgr_unregister_conn(conn);
315 node = rb_first(&lgr->conns_all);
316 }
317 write_unlock_bh(&lgr->conns_lock);
318 schedule_delayed_work(&lgr->free_work, SMC_LGR_FREE_DELAY);
319}
320
321/* Determine vlan of internal TCP socket.
322 * @vlan_id: address to store the determined vlan id into
323 */
324static int smc_vlan_by_tcpsk(struct socket *clcsock, unsigned short *vlan_id)
325{
326 struct dst_entry *dst = sk_dst_get(clcsock->sk);
327 int rc = 0;
328
329 *vlan_id = 0;
330 if (!dst) {
331 rc = -ENOTCONN;
332 goto out;
333 }
334 if (!dst->dev) {
335 rc = -ENODEV;
336 goto out_rel;
337 }
338
339 if (is_vlan_dev(dst->dev))
340 *vlan_id = vlan_dev_vlan_id(dst->dev);
341
342out_rel:
343 dst_release(dst);
344out:
345 return rc;
346}
347
348/* determine the link gid matching the vlan id of the link group */
349static int smc_link_determine_gid(struct smc_link_group *lgr)
350{
351 struct smc_link *lnk = &lgr->lnk[SMC_SINGLE_LINK];
352 struct ib_gid_attr gattr;
353 union ib_gid gid;
354 int i;
355
356 if (!lgr->vlan_id) {
357 lnk->gid = lnk->smcibdev->gid[lnk->ibport - 1];
358 return 0;
359 }
360
361 for (i = 0; i < lnk->smcibdev->pattr[lnk->ibport - 1].gid_tbl_len;
362 i++) {
363 if (ib_query_gid(lnk->smcibdev->ibdev, lnk->ibport, i, &gid,
364 &gattr))
365 continue;
366 if (gattr.ndev &&
367 (vlan_dev_vlan_id(gattr.ndev) == lgr->vlan_id)) {
368 lnk->gid = gid;
369 return 0;
370 }
371 }
372 return -ENODEV;
373}
374
375/* create a new SMC connection (and a new link group if necessary) */
376int smc_conn_create(struct smc_sock *smc, __be32 peer_in_addr,
377 struct smc_ib_device *smcibdev, u8 ibport,
378 struct smc_clc_msg_local *lcl, int srv_first_contact)
379{
380 struct smc_connection *conn = &smc->conn;
381 struct smc_link_group *lgr;
382 unsigned short vlan_id;
383 enum smc_lgr_role role;
384 int local_contact = SMC_FIRST_CONTACT;
385 int rc = 0;
386
387 role = smc->listen_smc ? SMC_SERV : SMC_CLNT;
388 rc = smc_vlan_by_tcpsk(smc->clcsock, &vlan_id);
389 if (rc)
390 return rc;
391
392 if ((role == SMC_CLNT) && srv_first_contact)
393 /* create new link group as well */
394 goto create;
395
396 /* determine if an existing link group can be reused */
397 spin_lock_bh(&smc_lgr_list.lock);
398 list_for_each_entry(lgr, &smc_lgr_list.list, list) {
399 write_lock_bh(&lgr->conns_lock);
400 if (!memcmp(lgr->peer_systemid, lcl->id_for_peer,
401 SMC_SYSTEMID_LEN) &&
402 !memcmp(lgr->lnk[SMC_SINGLE_LINK].peer_gid, &lcl->gid,
403 SMC_GID_SIZE) &&
404 !memcmp(lgr->lnk[SMC_SINGLE_LINK].peer_mac, lcl->mac,
405 sizeof(lcl->mac)) &&
406 !lgr->sync_err &&
407 (lgr->role == role) &&
Ursula Brauncd6851f2017-01-09 16:55:18 +0100408 (lgr->vlan_id == vlan_id) &&
409 ((role == SMC_CLNT) ||
410 (lgr->conns_num < SMC_RMBS_PER_LGR_MAX))) {
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100411 /* link group found */
412 local_contact = SMC_REUSE_CONTACT;
413 conn->lgr = lgr;
414 smc_lgr_register_conn(conn); /* add smc conn to lgr */
415 write_unlock_bh(&lgr->conns_lock);
416 break;
417 }
418 write_unlock_bh(&lgr->conns_lock);
419 }
420 spin_unlock_bh(&smc_lgr_list.lock);
421
422 if (role == SMC_CLNT && !srv_first_contact &&
423 (local_contact == SMC_FIRST_CONTACT)) {
424 /* Server reuses a link group, but Client wants to start
425 * a new one
426 * send out_of_sync decline, reason synchr. error
427 */
428 return -ENOLINK;
429 }
430
431create:
432 if (local_contact == SMC_FIRST_CONTACT) {
433 rc = smc_lgr_create(smc, peer_in_addr, smcibdev, ibport,
434 lcl->id_for_peer, vlan_id);
435 if (rc)
436 goto out;
437 smc_lgr_register_conn(conn); /* add smc conn to lgr */
438 rc = smc_link_determine_gid(conn->lgr);
439 }
Ursula Braun5f083182017-01-09 16:55:22 +0100440 conn->local_tx_ctrl.common.type = SMC_CDC_MSG_TYPE;
441 conn->local_tx_ctrl.len = sizeof(struct smc_cdc_msg);
442#ifndef KERNEL_HAS_ATOMIC64
443 spin_lock_init(&conn->acurs_lock);
444#endif
Ursula Braun0cfdd8f2017-01-09 16:55:17 +0100445
446out:
447 return rc ? rc : local_contact;
448}
Ursula Brauncd6851f2017-01-09 16:55:18 +0100449
450/* try to reuse a sndbuf description slot of the sndbufs list for a certain
451 * buf_size; if not available, return NULL
452 */
453static inline
454struct smc_buf_desc *smc_sndbuf_get_slot(struct smc_link_group *lgr,
455 int compressed_bufsize)
456{
457 struct smc_buf_desc *sndbuf_slot;
458
459 read_lock_bh(&lgr->sndbufs_lock);
460 list_for_each_entry(sndbuf_slot, &lgr->sndbufs[compressed_bufsize],
461 list) {
462 if (cmpxchg(&sndbuf_slot->used, 0, 1) == 0) {
463 read_unlock_bh(&lgr->sndbufs_lock);
464 return sndbuf_slot;
465 }
466 }
467 read_unlock_bh(&lgr->sndbufs_lock);
468 return NULL;
469}
470
471/* try to reuse an rmb description slot of the rmbs list for a certain
472 * rmbe_size; if not available, return NULL
473 */
474static inline
475struct smc_buf_desc *smc_rmb_get_slot(struct smc_link_group *lgr,
476 int compressed_bufsize)
477{
478 struct smc_buf_desc *rmb_slot;
479
480 read_lock_bh(&lgr->rmbs_lock);
481 list_for_each_entry(rmb_slot, &lgr->rmbs[compressed_bufsize],
482 list) {
483 if (cmpxchg(&rmb_slot->used, 0, 1) == 0) {
484 read_unlock_bh(&lgr->rmbs_lock);
485 return rmb_slot;
486 }
487 }
488 read_unlock_bh(&lgr->rmbs_lock);
489 return NULL;
490}
491
Ursula Braun952310c2017-01-09 16:55:24 +0100492/* one of the conditions for announcing a receiver's current window size is
493 * that it "results in a minimum increase in the window size of 10% of the
494 * receive buffer space" [RFC7609]
495 */
496static inline int smc_rmb_wnd_update_limit(int rmbe_size)
497{
498 return min_t(int, rmbe_size / 10, SOCK_MIN_SNDBUF / 2);
499}
500
Ursula Brauncd6851f2017-01-09 16:55:18 +0100501/* create the tx buffer for an SMC socket */
502int smc_sndbuf_create(struct smc_sock *smc)
503{
504 struct smc_connection *conn = &smc->conn;
505 struct smc_link_group *lgr = conn->lgr;
506 int tmp_bufsize, tmp_bufsize_short;
507 struct smc_buf_desc *sndbuf_desc;
508 int rc;
509
510 /* use socket send buffer size (w/o overhead) as start value */
511 for (tmp_bufsize_short = smc_compress_bufsize(smc->sk.sk_sndbuf / 2);
512 tmp_bufsize_short >= 0; tmp_bufsize_short--) {
513 tmp_bufsize = smc_uncompress_bufsize(tmp_bufsize_short);
514 /* check for reusable sndbuf_slot in the link group */
515 sndbuf_desc = smc_sndbuf_get_slot(lgr, tmp_bufsize_short);
516 if (sndbuf_desc) {
517 memset(sndbuf_desc->cpu_addr, 0, tmp_bufsize);
518 break; /* found reusable slot */
519 }
520 /* try to alloc a new send buffer */
521 sndbuf_desc = kzalloc(sizeof(*sndbuf_desc), GFP_KERNEL);
522 if (!sndbuf_desc)
523 break; /* give up with -ENOMEM */
524 sndbuf_desc->cpu_addr = kzalloc(tmp_bufsize,
525 GFP_KERNEL | __GFP_NOWARN |
526 __GFP_NOMEMALLOC |
527 __GFP_NORETRY);
528 if (!sndbuf_desc->cpu_addr) {
529 kfree(sndbuf_desc);
530 /* if send buffer allocation has failed,
531 * try a smaller one
532 */
533 continue;
534 }
535 rc = smc_ib_buf_map(lgr->lnk[SMC_SINGLE_LINK].smcibdev,
536 tmp_bufsize, sndbuf_desc,
537 DMA_TO_DEVICE);
538 if (rc) {
539 kfree(sndbuf_desc->cpu_addr);
540 kfree(sndbuf_desc);
541 continue; /* if mapping failed, try smaller one */
542 }
543 sndbuf_desc->used = 1;
544 write_lock_bh(&lgr->sndbufs_lock);
545 list_add(&sndbuf_desc->list,
546 &lgr->sndbufs[tmp_bufsize_short]);
547 write_unlock_bh(&lgr->sndbufs_lock);
548 break;
549 }
550 if (sndbuf_desc && sndbuf_desc->cpu_addr) {
551 conn->sndbuf_desc = sndbuf_desc;
552 conn->sndbuf_size = tmp_bufsize;
553 smc->sk.sk_sndbuf = tmp_bufsize * 2;
Ursula Braun5f083182017-01-09 16:55:22 +0100554 atomic_set(&conn->sndbuf_space, tmp_bufsize);
Ursula Brauncd6851f2017-01-09 16:55:18 +0100555 return 0;
556 } else {
557 return -ENOMEM;
558 }
559}
560
561/* create the RMB for an SMC socket (even though the SMC protocol
562 * allows more than one RMB-element per RMB, the Linux implementation
563 * uses just one RMB-element per RMB, i.e. uses an extra RMB for every
564 * connection in a link group
565 */
566int smc_rmb_create(struct smc_sock *smc)
567{
568 struct smc_connection *conn = &smc->conn;
569 struct smc_link_group *lgr = conn->lgr;
570 int tmp_bufsize, tmp_bufsize_short;
571 struct smc_buf_desc *rmb_desc;
572 int rc;
573
574 /* use socket recv buffer size (w/o overhead) as start value */
575 for (tmp_bufsize_short = smc_compress_bufsize(smc->sk.sk_rcvbuf / 2);
576 tmp_bufsize_short >= 0; tmp_bufsize_short--) {
577 tmp_bufsize = smc_uncompress_bufsize(tmp_bufsize_short);
578 /* check for reusable rmb_slot in the link group */
579 rmb_desc = smc_rmb_get_slot(lgr, tmp_bufsize_short);
580 if (rmb_desc) {
581 memset(rmb_desc->cpu_addr, 0, tmp_bufsize);
582 break; /* found reusable slot */
583 }
584 /* try to alloc a new RMB */
585 rmb_desc = kzalloc(sizeof(*rmb_desc), GFP_KERNEL);
586 if (!rmb_desc)
587 break; /* give up with -ENOMEM */
588 rmb_desc->cpu_addr = kzalloc(tmp_bufsize,
589 GFP_KERNEL | __GFP_NOWARN |
590 __GFP_NOMEMALLOC |
591 __GFP_NORETRY);
592 if (!rmb_desc->cpu_addr) {
593 kfree(rmb_desc);
594 /* if RMB allocation has failed,
595 * try a smaller one
596 */
597 continue;
598 }
599 rc = smc_ib_buf_map(lgr->lnk[SMC_SINGLE_LINK].smcibdev,
600 tmp_bufsize, rmb_desc,
601 DMA_FROM_DEVICE);
602 if (rc) {
603 kfree(rmb_desc->cpu_addr);
604 kfree(rmb_desc);
605 continue; /* if mapping failed, try smaller one */
606 }
Ursula Braunbd4ad572017-01-09 16:55:20 +0100607 rc = smc_ib_get_memory_region(lgr->lnk[SMC_SINGLE_LINK].roce_pd,
608 IB_ACCESS_REMOTE_WRITE |
609 IB_ACCESS_LOCAL_WRITE,
610 &rmb_desc->mr_rx[SMC_SINGLE_LINK]);
611 if (rc) {
612 smc_ib_buf_unmap(lgr->lnk[SMC_SINGLE_LINK].smcibdev,
613 tmp_bufsize, rmb_desc,
614 DMA_FROM_DEVICE);
615 kfree(rmb_desc->cpu_addr);
616 kfree(rmb_desc);
617 continue;
618 }
Ursula Brauncd6851f2017-01-09 16:55:18 +0100619 rmb_desc->used = 1;
620 write_lock_bh(&lgr->rmbs_lock);
621 list_add(&rmb_desc->list,
622 &lgr->rmbs[tmp_bufsize_short]);
623 write_unlock_bh(&lgr->rmbs_lock);
624 break;
625 }
626 if (rmb_desc && rmb_desc->cpu_addr) {
627 conn->rmb_desc = rmb_desc;
628 conn->rmbe_size = tmp_bufsize;
629 conn->rmbe_size_short = tmp_bufsize_short;
630 smc->sk.sk_rcvbuf = tmp_bufsize * 2;
Ursula Braun5f083182017-01-09 16:55:22 +0100631 atomic_set(&conn->bytes_to_rcv, 0);
Ursula Braun952310c2017-01-09 16:55:24 +0100632 conn->rmbe_update_limit = smc_rmb_wnd_update_limit(tmp_bufsize);
Ursula Brauncd6851f2017-01-09 16:55:18 +0100633 return 0;
634 } else {
635 return -ENOMEM;
636 }
637}
Ursula Braunbd4ad572017-01-09 16:55:20 +0100638
639static inline int smc_rmb_reserve_rtoken_idx(struct smc_link_group *lgr)
640{
641 int i;
642
643 for_each_clear_bit(i, lgr->rtokens_used_mask, SMC_RMBS_PER_LGR_MAX) {
644 if (!test_and_set_bit(i, lgr->rtokens_used_mask))
645 return i;
646 }
647 return -ENOSPC;
648}
649
650/* save rkey and dma_addr received from peer during clc handshake */
651int smc_rmb_rtoken_handling(struct smc_connection *conn,
652 struct smc_clc_msg_accept_confirm *clc)
653{
654 u64 dma_addr = be64_to_cpu(clc->rmb_dma_addr);
655 struct smc_link_group *lgr = conn->lgr;
656 u32 rkey = ntohl(clc->rmb_rkey);
657 int i;
658
659 for (i = 0; i < SMC_RMBS_PER_LGR_MAX; i++) {
660 if ((lgr->rtokens[i][SMC_SINGLE_LINK].rkey == rkey) &&
661 test_bit(i, lgr->rtokens_used_mask)) {
662 conn->rtoken_idx = i;
663 return 0;
664 }
665 }
666 conn->rtoken_idx = smc_rmb_reserve_rtoken_idx(lgr);
667 if (conn->rtoken_idx < 0)
668 return conn->rtoken_idx;
669 lgr->rtokens[conn->rtoken_idx][SMC_SINGLE_LINK].rkey = rkey;
670 lgr->rtokens[conn->rtoken_idx][SMC_SINGLE_LINK].dma_addr = dma_addr;
671 return 0;
672}