xref: /linux/net/smc/smc_clc.c (revision 02000b55850deeadffe433e4b4930a8831f477de)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *  Shared Memory Communications over RDMA (SMC-R) and RoCE
4  *
5  *  CLC (connection layer control) handshake over initial TCP socket to
6  *  prepare for RDMA traffic
7  *
8  *  Copyright IBM Corp. 2016, 2018
9  *
10  *  Author(s):  Ursula Braun <ubraun@linux.vnet.ibm.com>
11  */
12 
13 #include <linux/in.h>
14 #include <linux/inetdevice.h>
15 #include <linux/if_ether.h>
16 #include <linux/sched/signal.h>
17 
18 #include <net/addrconf.h>
19 #include <net/sock.h>
20 #include <net/tcp.h>
21 
22 #include "smc.h"
23 #include "smc_core.h"
24 #include "smc_clc.h"
25 #include "smc_ib.h"
26 #include "smc_ism.h"
27 
28 #define SMCR_CLC_ACCEPT_CONFIRM_LEN 68
29 #define SMCD_CLC_ACCEPT_CONFIRM_LEN 48
30 
31 /* eye catcher "SMCR" EBCDIC for CLC messages */
32 static const char SMC_EYECATCHER[4] = {'\xe2', '\xd4', '\xc3', '\xd9'};
33 /* eye catcher "SMCD" EBCDIC for CLC messages */
34 static const char SMCD_EYECATCHER[4] = {'\xe2', '\xd4', '\xc3', '\xc4'};
35 
36 /* check if received message has a correct header length and contains valid
37  * heading and trailing eyecatchers
38  */
39 static bool smc_clc_msg_hdr_valid(struct smc_clc_msg_hdr *clcm)
40 {
41 	struct smc_clc_msg_proposal_prefix *pclc_prfx;
42 	struct smc_clc_msg_accept_confirm *clc;
43 	struct smc_clc_msg_proposal *pclc;
44 	struct smc_clc_msg_decline *dclc;
45 	struct smc_clc_msg_trail *trl;
46 
47 	if (memcmp(clcm->eyecatcher, SMC_EYECATCHER, sizeof(SMC_EYECATCHER)) &&
48 	    memcmp(clcm->eyecatcher, SMCD_EYECATCHER, sizeof(SMCD_EYECATCHER)))
49 		return false;
50 	switch (clcm->type) {
51 	case SMC_CLC_PROPOSAL:
52 		if (clcm->path != SMC_TYPE_R && clcm->path != SMC_TYPE_D &&
53 		    clcm->path != SMC_TYPE_B)
54 			return false;
55 		pclc = (struct smc_clc_msg_proposal *)clcm;
56 		pclc_prfx = smc_clc_proposal_get_prefix(pclc);
57 		if (ntohs(pclc->hdr.length) !=
58 			sizeof(*pclc) + ntohs(pclc->iparea_offset) +
59 			sizeof(*pclc_prfx) +
60 			pclc_prfx->ipv6_prefixes_cnt *
61 				sizeof(struct smc_clc_ipv6_prefix) +
62 			sizeof(*trl))
63 			return false;
64 		trl = (struct smc_clc_msg_trail *)
65 			((u8 *)pclc + ntohs(pclc->hdr.length) - sizeof(*trl));
66 		break;
67 	case SMC_CLC_ACCEPT:
68 	case SMC_CLC_CONFIRM:
69 		if (clcm->path != SMC_TYPE_R && clcm->path != SMC_TYPE_D)
70 			return false;
71 		clc = (struct smc_clc_msg_accept_confirm *)clcm;
72 		if ((clcm->path == SMC_TYPE_R &&
73 		     ntohs(clc->hdr.length) != SMCR_CLC_ACCEPT_CONFIRM_LEN) ||
74 		    (clcm->path == SMC_TYPE_D &&
75 		     ntohs(clc->hdr.length) != SMCD_CLC_ACCEPT_CONFIRM_LEN))
76 			return false;
77 		trl = (struct smc_clc_msg_trail *)
78 			((u8 *)clc + ntohs(clc->hdr.length) - sizeof(*trl));
79 		break;
80 	case SMC_CLC_DECLINE:
81 		dclc = (struct smc_clc_msg_decline *)clcm;
82 		if (ntohs(dclc->hdr.length) != sizeof(*dclc))
83 			return false;
84 		trl = &dclc->trl;
85 		break;
86 	default:
87 		return false;
88 	}
89 	if (memcmp(trl->eyecatcher, SMC_EYECATCHER, sizeof(SMC_EYECATCHER)) &&
90 	    memcmp(trl->eyecatcher, SMCD_EYECATCHER, sizeof(SMCD_EYECATCHER)))
91 		return false;
92 	return true;
93 }
94 
95 /* find ipv4 addr on device and get the prefix len, fill CLC proposal msg */
96 static int smc_clc_prfx_set4_rcu(struct dst_entry *dst, __be32 ipv4,
97 				 struct smc_clc_msg_proposal_prefix *prop)
98 {
99 	struct in_device *in_dev = __in_dev_get_rcu(dst->dev);
100 
101 	if (!in_dev)
102 		return -ENODEV;
103 	for_ifa(in_dev) {
104 		if (!inet_ifa_match(ipv4, ifa))
105 			continue;
106 		prop->prefix_len = inet_mask_len(ifa->ifa_mask);
107 		prop->outgoing_subnet = ifa->ifa_address & ifa->ifa_mask;
108 		/* prop->ipv6_prefixes_cnt = 0; already done by memset before */
109 		return 0;
110 	} endfor_ifa(in_dev);
111 	return -ENOENT;
112 }
113 
114 /* fill CLC proposal msg with ipv6 prefixes from device */
115 static int smc_clc_prfx_set6_rcu(struct dst_entry *dst,
116 				 struct smc_clc_msg_proposal_prefix *prop,
117 				 struct smc_clc_ipv6_prefix *ipv6_prfx)
118 {
119 #if IS_ENABLED(CONFIG_IPV6)
120 	struct inet6_dev *in6_dev = __in6_dev_get(dst->dev);
121 	struct inet6_ifaddr *ifa;
122 	int cnt = 0;
123 
124 	if (!in6_dev)
125 		return -ENODEV;
126 	/* use a maximum of 8 IPv6 prefixes from device */
127 	list_for_each_entry(ifa, &in6_dev->addr_list, if_list) {
128 		if (ipv6_addr_type(&ifa->addr) & IPV6_ADDR_LINKLOCAL)
129 			continue;
130 		ipv6_addr_prefix(&ipv6_prfx[cnt].prefix,
131 				 &ifa->addr, ifa->prefix_len);
132 		ipv6_prfx[cnt].prefix_len = ifa->prefix_len;
133 		cnt++;
134 		if (cnt == SMC_CLC_MAX_V6_PREFIX)
135 			break;
136 	}
137 	prop->ipv6_prefixes_cnt = cnt;
138 	if (cnt)
139 		return 0;
140 #endif
141 	return -ENOENT;
142 }
143 
144 /* retrieve and set prefixes in CLC proposal msg */
145 static int smc_clc_prfx_set(struct socket *clcsock,
146 			    struct smc_clc_msg_proposal_prefix *prop,
147 			    struct smc_clc_ipv6_prefix *ipv6_prfx)
148 {
149 	struct dst_entry *dst = sk_dst_get(clcsock->sk);
150 	struct sockaddr_storage addrs;
151 	struct sockaddr_in6 *addr6;
152 	struct sockaddr_in *addr;
153 	int rc = -ENOENT;
154 
155 	memset(prop, 0, sizeof(*prop));
156 	if (!dst) {
157 		rc = -ENOTCONN;
158 		goto out;
159 	}
160 	if (!dst->dev) {
161 		rc = -ENODEV;
162 		goto out_rel;
163 	}
164 	/* get address to which the internal TCP socket is bound */
165 	kernel_getsockname(clcsock, (struct sockaddr *)&addrs);
166 	/* analyze IP specific data of net_device belonging to TCP socket */
167 	addr6 = (struct sockaddr_in6 *)&addrs;
168 	rcu_read_lock();
169 	if (addrs.ss_family == PF_INET) {
170 		/* IPv4 */
171 		addr = (struct sockaddr_in *)&addrs;
172 		rc = smc_clc_prfx_set4_rcu(dst, addr->sin_addr.s_addr, prop);
173 	} else if (ipv6_addr_v4mapped(&addr6->sin6_addr)) {
174 		/* mapped IPv4 address - peer is IPv4 only */
175 		rc = smc_clc_prfx_set4_rcu(dst, addr6->sin6_addr.s6_addr32[3],
176 					   prop);
177 	} else {
178 		/* IPv6 */
179 		rc = smc_clc_prfx_set6_rcu(dst, prop, ipv6_prfx);
180 	}
181 	rcu_read_unlock();
182 out_rel:
183 	dst_release(dst);
184 out:
185 	return rc;
186 }
187 
188 /* match ipv4 addrs of dev against addr in CLC proposal */
189 static int smc_clc_prfx_match4_rcu(struct net_device *dev,
190 				   struct smc_clc_msg_proposal_prefix *prop)
191 {
192 	struct in_device *in_dev = __in_dev_get_rcu(dev);
193 
194 	if (!in_dev)
195 		return -ENODEV;
196 	for_ifa(in_dev) {
197 		if (prop->prefix_len == inet_mask_len(ifa->ifa_mask) &&
198 		    inet_ifa_match(prop->outgoing_subnet, ifa))
199 			return 0;
200 	} endfor_ifa(in_dev);
201 
202 	return -ENOENT;
203 }
204 
205 /* match ipv6 addrs of dev against addrs in CLC proposal */
206 static int smc_clc_prfx_match6_rcu(struct net_device *dev,
207 				   struct smc_clc_msg_proposal_prefix *prop)
208 {
209 #if IS_ENABLED(CONFIG_IPV6)
210 	struct inet6_dev *in6_dev = __in6_dev_get(dev);
211 	struct smc_clc_ipv6_prefix *ipv6_prfx;
212 	struct inet6_ifaddr *ifa;
213 	int i, max;
214 
215 	if (!in6_dev)
216 		return -ENODEV;
217 	/* ipv6 prefix list starts behind smc_clc_msg_proposal_prefix */
218 	ipv6_prfx = (struct smc_clc_ipv6_prefix *)((u8 *)prop + sizeof(*prop));
219 	max = min_t(u8, prop->ipv6_prefixes_cnt, SMC_CLC_MAX_V6_PREFIX);
220 	list_for_each_entry(ifa, &in6_dev->addr_list, if_list) {
221 		if (ipv6_addr_type(&ifa->addr) & IPV6_ADDR_LINKLOCAL)
222 			continue;
223 		for (i = 0; i < max; i++) {
224 			if (ifa->prefix_len == ipv6_prfx[i].prefix_len &&
225 			    ipv6_prefix_equal(&ifa->addr, &ipv6_prfx[i].prefix,
226 					      ifa->prefix_len))
227 				return 0;
228 		}
229 	}
230 #endif
231 	return -ENOENT;
232 }
233 
234 /* check if proposed prefixes match one of our device prefixes */
235 int smc_clc_prfx_match(struct socket *clcsock,
236 		       struct smc_clc_msg_proposal_prefix *prop)
237 {
238 	struct dst_entry *dst = sk_dst_get(clcsock->sk);
239 	int rc;
240 
241 	if (!dst) {
242 		rc = -ENOTCONN;
243 		goto out;
244 	}
245 	if (!dst->dev) {
246 		rc = -ENODEV;
247 		goto out_rel;
248 	}
249 	rcu_read_lock();
250 	if (!prop->ipv6_prefixes_cnt)
251 		rc = smc_clc_prfx_match4_rcu(dst->dev, prop);
252 	else
253 		rc = smc_clc_prfx_match6_rcu(dst->dev, prop);
254 	rcu_read_unlock();
255 out_rel:
256 	dst_release(dst);
257 out:
258 	return rc;
259 }
260 
261 /* Wait for data on the tcp-socket, analyze received data
262  * Returns:
263  * 0 if success and it was not a decline that we received.
264  * SMC_CLC_DECL_REPLY if decline received for fallback w/o another decl send.
265  * clcsock error, -EINTR, -ECONNRESET, -EPROTO otherwise.
266  */
267 int smc_clc_wait_msg(struct smc_sock *smc, void *buf, int buflen,
268 		     u8 expected_type)
269 {
270 	struct sock *clc_sk = smc->clcsock->sk;
271 	struct smc_clc_msg_hdr *clcm = buf;
272 	struct msghdr msg = {NULL, 0};
273 	int reason_code = 0;
274 	struct kvec vec = {buf, buflen};
275 	int len, datlen;
276 	int krflags;
277 
278 	/* peek the first few bytes to determine length of data to receive
279 	 * so we don't consume any subsequent CLC message or payload data
280 	 * in the TCP byte stream
281 	 */
282 	/*
283 	 * Caller must make sure that buflen is no less than
284 	 * sizeof(struct smc_clc_msg_hdr)
285 	 */
286 	krflags = MSG_PEEK | MSG_WAITALL;
287 	smc->clcsock->sk->sk_rcvtimeo = CLC_WAIT_TIME;
288 	iov_iter_kvec(&msg.msg_iter, READ | ITER_KVEC, &vec, 1,
289 			sizeof(struct smc_clc_msg_hdr));
290 	len = sock_recvmsg(smc->clcsock, &msg, krflags);
291 	if (signal_pending(current)) {
292 		reason_code = -EINTR;
293 		clc_sk->sk_err = EINTR;
294 		smc->sk.sk_err = EINTR;
295 		goto out;
296 	}
297 	if (clc_sk->sk_err) {
298 		reason_code = -clc_sk->sk_err;
299 		smc->sk.sk_err = clc_sk->sk_err;
300 		goto out;
301 	}
302 	if (!len) { /* peer has performed orderly shutdown */
303 		smc->sk.sk_err = ECONNRESET;
304 		reason_code = -ECONNRESET;
305 		goto out;
306 	}
307 	if (len < 0) {
308 		smc->sk.sk_err = -len;
309 		reason_code = len;
310 		goto out;
311 	}
312 	datlen = ntohs(clcm->length);
313 	if ((len < sizeof(struct smc_clc_msg_hdr)) ||
314 	    (datlen > buflen) ||
315 	    (clcm->version != SMC_CLC_V1) ||
316 	    (clcm->path != SMC_TYPE_R && clcm->path != SMC_TYPE_D &&
317 	     clcm->path != SMC_TYPE_B) ||
318 	    ((clcm->type != SMC_CLC_DECLINE) &&
319 	     (clcm->type != expected_type))) {
320 		smc->sk.sk_err = EPROTO;
321 		reason_code = -EPROTO;
322 		goto out;
323 	}
324 
325 	/* receive the complete CLC message */
326 	memset(&msg, 0, sizeof(struct msghdr));
327 	iov_iter_kvec(&msg.msg_iter, READ | ITER_KVEC, &vec, 1, datlen);
328 	krflags = MSG_WAITALL;
329 	smc->clcsock->sk->sk_rcvtimeo = CLC_WAIT_TIME;
330 	len = sock_recvmsg(smc->clcsock, &msg, krflags);
331 	if (len < datlen || !smc_clc_msg_hdr_valid(clcm)) {
332 		smc->sk.sk_err = EPROTO;
333 		reason_code = -EPROTO;
334 		goto out;
335 	}
336 	if (clcm->type == SMC_CLC_DECLINE) {
337 		reason_code = SMC_CLC_DECL_REPLY;
338 		if (((struct smc_clc_msg_decline *)buf)->hdr.flag) {
339 			smc->conn.lgr->sync_err = 1;
340 			smc_lgr_terminate(smc->conn.lgr);
341 		}
342 	}
343 
344 out:
345 	return reason_code;
346 }
347 
348 /* send CLC DECLINE message across internal TCP socket */
349 int smc_clc_send_decline(struct smc_sock *smc, u32 peer_diag_info)
350 {
351 	struct smc_clc_msg_decline dclc;
352 	struct msghdr msg;
353 	struct kvec vec;
354 	int len;
355 
356 	memset(&dclc, 0, sizeof(dclc));
357 	memcpy(dclc.hdr.eyecatcher, SMC_EYECATCHER, sizeof(SMC_EYECATCHER));
358 	dclc.hdr.type = SMC_CLC_DECLINE;
359 	dclc.hdr.length = htons(sizeof(struct smc_clc_msg_decline));
360 	dclc.hdr.version = SMC_CLC_V1;
361 	dclc.hdr.flag = (peer_diag_info == SMC_CLC_DECL_SYNCERR) ? 1 : 0;
362 	memcpy(dclc.id_for_peer, local_systemid, sizeof(local_systemid));
363 	dclc.peer_diagnosis = htonl(peer_diag_info);
364 	memcpy(dclc.trl.eyecatcher, SMC_EYECATCHER, sizeof(SMC_EYECATCHER));
365 
366 	memset(&msg, 0, sizeof(msg));
367 	vec.iov_base = &dclc;
368 	vec.iov_len = sizeof(struct smc_clc_msg_decline);
369 	len = kernel_sendmsg(smc->clcsock, &msg, &vec, 1,
370 			     sizeof(struct smc_clc_msg_decline));
371 	if (len < sizeof(struct smc_clc_msg_decline))
372 		smc->sk.sk_err = EPROTO;
373 	if (len < 0)
374 		smc->sk.sk_err = -len;
375 	return sock_error(&smc->sk);
376 }
377 
378 /* send CLC PROPOSAL message across internal TCP socket */
379 int smc_clc_send_proposal(struct smc_sock *smc, int smc_type,
380 			  struct smc_ib_device *ibdev, u8 ibport,
381 			  struct smcd_dev *ismdev)
382 {
383 	struct smc_clc_ipv6_prefix ipv6_prfx[SMC_CLC_MAX_V6_PREFIX];
384 	struct smc_clc_msg_proposal_prefix pclc_prfx;
385 	struct smc_clc_msg_smcd pclc_smcd;
386 	struct smc_clc_msg_proposal pclc;
387 	struct smc_clc_msg_trail trl;
388 	int len, i, plen, rc;
389 	int reason_code = 0;
390 	struct kvec vec[5];
391 	struct msghdr msg;
392 
393 	/* retrieve ip prefixes for CLC proposal msg */
394 	rc = smc_clc_prfx_set(smc->clcsock, &pclc_prfx, ipv6_prfx);
395 	if (rc)
396 		return SMC_CLC_DECL_CNFERR; /* configuration error */
397 
398 	/* send SMC Proposal CLC message */
399 	plen = sizeof(pclc) + sizeof(pclc_prfx) +
400 	       (pclc_prfx.ipv6_prefixes_cnt * sizeof(ipv6_prfx[0])) +
401 	       sizeof(trl);
402 	memset(&pclc, 0, sizeof(pclc));
403 	memcpy(pclc.hdr.eyecatcher, SMC_EYECATCHER, sizeof(SMC_EYECATCHER));
404 	pclc.hdr.type = SMC_CLC_PROPOSAL;
405 	pclc.hdr.version = SMC_CLC_V1;		/* SMC version */
406 	pclc.hdr.path = smc_type;
407 	if (smc_type == SMC_TYPE_R || smc_type == SMC_TYPE_B) {
408 		/* add SMC-R specifics */
409 		memcpy(pclc.lcl.id_for_peer, local_systemid,
410 		       sizeof(local_systemid));
411 		memcpy(&pclc.lcl.gid, &ibdev->gid[ibport - 1], SMC_GID_SIZE);
412 		memcpy(&pclc.lcl.mac, &ibdev->mac[ibport - 1], ETH_ALEN);
413 		pclc.iparea_offset = htons(0);
414 	}
415 	if (smc_type == SMC_TYPE_D || smc_type == SMC_TYPE_B) {
416 		/* add SMC-D specifics */
417 		memset(&pclc_smcd, 0, sizeof(pclc_smcd));
418 		plen += sizeof(pclc_smcd);
419 		pclc.iparea_offset = htons(SMC_CLC_PROPOSAL_MAX_OFFSET);
420 		pclc_smcd.gid = ismdev->local_gid;
421 	}
422 	pclc.hdr.length = htons(plen);
423 
424 	memcpy(trl.eyecatcher, SMC_EYECATCHER, sizeof(SMC_EYECATCHER));
425 	memset(&msg, 0, sizeof(msg));
426 	i = 0;
427 	vec[i].iov_base = &pclc;
428 	vec[i++].iov_len = sizeof(pclc);
429 	if (smc_type == SMC_TYPE_D || smc_type == SMC_TYPE_B) {
430 		vec[i].iov_base = &pclc_smcd;
431 		vec[i++].iov_len = sizeof(pclc_smcd);
432 	}
433 	vec[i].iov_base = &pclc_prfx;
434 	vec[i++].iov_len = sizeof(pclc_prfx);
435 	if (pclc_prfx.ipv6_prefixes_cnt > 0) {
436 		vec[i].iov_base = &ipv6_prfx[0];
437 		vec[i++].iov_len = pclc_prfx.ipv6_prefixes_cnt *
438 				   sizeof(ipv6_prfx[0]);
439 	}
440 	vec[i].iov_base = &trl;
441 	vec[i++].iov_len = sizeof(trl);
442 	/* due to the few bytes needed for clc-handshake this cannot block */
443 	len = kernel_sendmsg(smc->clcsock, &msg, vec, i, plen);
444 	if (len < sizeof(pclc)) {
445 		if (len >= 0) {
446 			reason_code = -ENETUNREACH;
447 			smc->sk.sk_err = -reason_code;
448 		} else {
449 			smc->sk.sk_err = smc->clcsock->sk->sk_err;
450 			reason_code = -smc->sk.sk_err;
451 		}
452 	}
453 
454 	return reason_code;
455 }
456 
457 /* send CLC CONFIRM message across internal TCP socket */
458 int smc_clc_send_confirm(struct smc_sock *smc)
459 {
460 	struct smc_connection *conn = &smc->conn;
461 	struct smc_clc_msg_accept_confirm cclc;
462 	struct smc_link *link;
463 	int reason_code = 0;
464 	struct msghdr msg;
465 	struct kvec vec;
466 	int len;
467 
468 	/* send SMC Confirm CLC msg */
469 	memset(&cclc, 0, sizeof(cclc));
470 	cclc.hdr.type = SMC_CLC_CONFIRM;
471 	cclc.hdr.version = SMC_CLC_V1;		/* SMC version */
472 	if (smc->conn.lgr->is_smcd) {
473 		/* SMC-D specific settings */
474 		memcpy(cclc.hdr.eyecatcher, SMCD_EYECATCHER,
475 		       sizeof(SMCD_EYECATCHER));
476 		cclc.hdr.path = SMC_TYPE_D;
477 		cclc.hdr.length = htons(SMCD_CLC_ACCEPT_CONFIRM_LEN);
478 		cclc.gid = conn->lgr->smcd->local_gid;
479 		cclc.token = conn->rmb_desc->token;
480 		cclc.dmbe_size = conn->rmbe_size_short;
481 		cclc.dmbe_idx = 0;
482 		memcpy(&cclc.linkid, conn->lgr->id, SMC_LGR_ID_SIZE);
483 		memcpy(cclc.smcd_trl.eyecatcher, SMCD_EYECATCHER,
484 		       sizeof(SMCD_EYECATCHER));
485 	} else {
486 		/* SMC-R specific settings */
487 		link = &conn->lgr->lnk[SMC_SINGLE_LINK];
488 		memcpy(cclc.hdr.eyecatcher, SMC_EYECATCHER,
489 		       sizeof(SMC_EYECATCHER));
490 		cclc.hdr.path = SMC_TYPE_R;
491 		cclc.hdr.length = htons(SMCR_CLC_ACCEPT_CONFIRM_LEN);
492 		memcpy(cclc.lcl.id_for_peer, local_systemid,
493 		       sizeof(local_systemid));
494 		memcpy(&cclc.lcl.gid, &link->smcibdev->gid[link->ibport - 1],
495 		       SMC_GID_SIZE);
496 		memcpy(&cclc.lcl.mac, &link->smcibdev->mac[link->ibport - 1],
497 		       ETH_ALEN);
498 		hton24(cclc.qpn, link->roce_qp->qp_num);
499 		cclc.rmb_rkey =
500 			htonl(conn->rmb_desc->mr_rx[SMC_SINGLE_LINK]->rkey);
501 		cclc.rmbe_idx = 1; /* for now: 1 RMB = 1 RMBE */
502 		cclc.rmbe_alert_token = htonl(conn->alert_token_local);
503 		cclc.qp_mtu = min(link->path_mtu, link->peer_mtu);
504 		cclc.rmbe_size = conn->rmbe_size_short;
505 		cclc.rmb_dma_addr = cpu_to_be64((u64)sg_dma_address
506 				(conn->rmb_desc->sgt[SMC_SINGLE_LINK].sgl));
507 		hton24(cclc.psn, link->psn_initial);
508 		memcpy(cclc.smcr_trl.eyecatcher, SMC_EYECATCHER,
509 		       sizeof(SMC_EYECATCHER));
510 	}
511 
512 	memset(&msg, 0, sizeof(msg));
513 	vec.iov_base = &cclc;
514 	vec.iov_len = ntohs(cclc.hdr.length);
515 	len = kernel_sendmsg(smc->clcsock, &msg, &vec, 1,
516 			     ntohs(cclc.hdr.length));
517 	if (len < ntohs(cclc.hdr.length)) {
518 		if (len >= 0) {
519 			reason_code = -ENETUNREACH;
520 			smc->sk.sk_err = -reason_code;
521 		} else {
522 			smc->sk.sk_err = smc->clcsock->sk->sk_err;
523 			reason_code = -smc->sk.sk_err;
524 		}
525 	}
526 	return reason_code;
527 }
528 
529 /* send CLC ACCEPT message across internal TCP socket */
530 int smc_clc_send_accept(struct smc_sock *new_smc, int srv_first_contact)
531 {
532 	struct smc_connection *conn = &new_smc->conn;
533 	struct smc_clc_msg_accept_confirm aclc;
534 	struct smc_link *link;
535 	struct msghdr msg;
536 	struct kvec vec;
537 	int rc = 0;
538 	int len;
539 
540 	memset(&aclc, 0, sizeof(aclc));
541 	aclc.hdr.type = SMC_CLC_ACCEPT;
542 	aclc.hdr.version = SMC_CLC_V1;		/* SMC version */
543 	if (srv_first_contact)
544 		aclc.hdr.flag = 1;
545 
546 	if (new_smc->conn.lgr->is_smcd) {
547 		/* SMC-D specific settings */
548 		aclc.hdr.length = htons(SMCD_CLC_ACCEPT_CONFIRM_LEN);
549 		memcpy(aclc.hdr.eyecatcher, SMCD_EYECATCHER,
550 		       sizeof(SMCD_EYECATCHER));
551 		aclc.hdr.path = SMC_TYPE_D;
552 		aclc.gid = conn->lgr->smcd->local_gid;
553 		aclc.token = conn->rmb_desc->token;
554 		aclc.dmbe_size = conn->rmbe_size_short;
555 		aclc.dmbe_idx = 0;
556 		memcpy(&aclc.linkid, conn->lgr->id, SMC_LGR_ID_SIZE);
557 		memcpy(aclc.smcd_trl.eyecatcher, SMCD_EYECATCHER,
558 		       sizeof(SMCD_EYECATCHER));
559 	} else {
560 		/* SMC-R specific settings */
561 		aclc.hdr.length = htons(SMCR_CLC_ACCEPT_CONFIRM_LEN);
562 		memcpy(aclc.hdr.eyecatcher, SMC_EYECATCHER,
563 		       sizeof(SMC_EYECATCHER));
564 		aclc.hdr.path = SMC_TYPE_R;
565 		link = &conn->lgr->lnk[SMC_SINGLE_LINK];
566 		memcpy(aclc.lcl.id_for_peer, local_systemid,
567 		       sizeof(local_systemid));
568 		memcpy(&aclc.lcl.gid, &link->smcibdev->gid[link->ibport - 1],
569 		       SMC_GID_SIZE);
570 		memcpy(&aclc.lcl.mac, link->smcibdev->mac[link->ibport - 1],
571 		       ETH_ALEN);
572 		hton24(aclc.qpn, link->roce_qp->qp_num);
573 		aclc.rmb_rkey =
574 			htonl(conn->rmb_desc->mr_rx[SMC_SINGLE_LINK]->rkey);
575 		aclc.rmbe_idx = 1;		/* as long as 1 RMB = 1 RMBE */
576 		aclc.rmbe_alert_token = htonl(conn->alert_token_local);
577 		aclc.qp_mtu = link->path_mtu;
578 		aclc.rmbe_size = conn->rmbe_size_short,
579 		aclc.rmb_dma_addr = cpu_to_be64((u64)sg_dma_address
580 				(conn->rmb_desc->sgt[SMC_SINGLE_LINK].sgl));
581 		hton24(aclc.psn, link->psn_initial);
582 		memcpy(aclc.smcr_trl.eyecatcher, SMC_EYECATCHER,
583 		       sizeof(SMC_EYECATCHER));
584 	}
585 
586 	memset(&msg, 0, sizeof(msg));
587 	vec.iov_base = &aclc;
588 	vec.iov_len = ntohs(aclc.hdr.length);
589 	len = kernel_sendmsg(new_smc->clcsock, &msg, &vec, 1,
590 			     ntohs(aclc.hdr.length));
591 	if (len < ntohs(aclc.hdr.length)) {
592 		if (len >= 0)
593 			new_smc->sk.sk_err = EPROTO;
594 		else
595 			new_smc->sk.sk_err = new_smc->clcsock->sk->sk_err;
596 		rc = sock_error(&new_smc->sk);
597 	}
598 
599 	return rc;
600 }
601