]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/staging/lustre/lnet/klnds/socklnd/socklnd_proto.c
Merge tag 'fbdev-main-3.15' of git://git.kernel.org/pub/scm/linux/kernel/git/tomba...
[mirror_ubuntu-bionic-kernel.git] / drivers / staging / lustre / lnet / klnds / socklnd / socklnd_proto.c
1 /*
2 * Copyright (c) 2009, 2010, Oracle and/or its affiliates. All rights reserved.
3 *
4 * Copyright (c) 2012, Intel Corporation.
5 *
6 * Author: Zach Brown <zab@zabbo.net>
7 * Author: Peter J. Braam <braam@clusterfs.com>
8 * Author: Phil Schwan <phil@clusterfs.com>
9 * Author: Eric Barton <eric@bartonsoftware.com>
10 *
11 * This file is part of Portals, http://www.sf.net/projects/sandiaportals/
12 *
13 * Portals is free software; you can redistribute it and/or
14 * modify it under the terms of version 2 of the GNU General Public
15 * License as published by the Free Software Foundation.
16 *
17 * Portals is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with Portals; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 */
26
27 #include "socklnd.h"
28
29 /*
30 * Protocol entries :
31 * pro_send_hello : send hello message
32 * pro_recv_hello : receive hello message
33 * pro_pack : pack message header
34 * pro_unpack : unpack message header
35 * pro_queue_tx_zcack() : Called holding BH lock: kss_lock
36 * return 1 if ACK is piggybacked, otherwise return 0
37 * pro_queue_tx_msg() : Called holding BH lock: kss_lock
38 * return the ACK that piggybacked by my message, or NULL
39 * pro_handle_zcreq() : handler of incoming ZC-REQ
40 * pro_handle_zcack() : handler of incoming ZC-ACK
41 * pro_match_tx() : Called holding glock
42 */
43
44 static ksock_tx_t *
45 ksocknal_queue_tx_msg_v1(ksock_conn_t *conn, ksock_tx_t *tx_msg)
46 {
47 /* V1.x, just enqueue it */
48 list_add_tail(&tx_msg->tx_list, &conn->ksnc_tx_queue);
49 return NULL;
50 }
51
52 void
53 ksocknal_next_tx_carrier(ksock_conn_t *conn)
54 {
55 ksock_tx_t *tx = conn->ksnc_tx_carrier;
56
57 /* Called holding BH lock: conn->ksnc_scheduler->kss_lock */
58 LASSERT (!list_empty(&conn->ksnc_tx_queue));
59 LASSERT (tx != NULL);
60
61 /* Next TX that can carry ZC-ACK or LNet message */
62 if (tx->tx_list.next == &conn->ksnc_tx_queue) {
63 /* no more packets queued */
64 conn->ksnc_tx_carrier = NULL;
65 } else {
66 conn->ksnc_tx_carrier = list_entry(tx->tx_list.next,
67 ksock_tx_t, tx_list);
68 LASSERT (conn->ksnc_tx_carrier->tx_msg.ksm_type == tx->tx_msg.ksm_type);
69 }
70 }
71
72 static int
73 ksocknal_queue_tx_zcack_v2(ksock_conn_t *conn,
74 ksock_tx_t *tx_ack, __u64 cookie)
75 {
76 ksock_tx_t *tx = conn->ksnc_tx_carrier;
77
78 LASSERT (tx_ack == NULL ||
79 tx_ack->tx_msg.ksm_type == KSOCK_MSG_NOOP);
80
81 /*
82 * Enqueue or piggyback tx_ack / cookie
83 * . no tx can piggyback cookie of tx_ack (or cookie), just
84 * enqueue the tx_ack (if tx_ack != NUL) and return NULL.
85 * . There is tx can piggyback cookie of tx_ack (or cookie),
86 * piggyback the cookie and return the tx.
87 */
88 if (tx == NULL) {
89 if (tx_ack != NULL) {
90 list_add_tail(&tx_ack->tx_list,
91 &conn->ksnc_tx_queue);
92 conn->ksnc_tx_carrier = tx_ack;
93 }
94 return 0;
95 }
96
97 if (tx->tx_msg.ksm_type == KSOCK_MSG_NOOP) {
98 /* tx is noop zc-ack, can't piggyback zc-ack cookie */
99 if (tx_ack != NULL)
100 list_add_tail(&tx_ack->tx_list,
101 &conn->ksnc_tx_queue);
102 return 0;
103 }
104
105 LASSERT(tx->tx_msg.ksm_type == KSOCK_MSG_LNET);
106 LASSERT(tx->tx_msg.ksm_zc_cookies[1] == 0);
107
108 if (tx_ack != NULL)
109 cookie = tx_ack->tx_msg.ksm_zc_cookies[1];
110
111 /* piggyback the zc-ack cookie */
112 tx->tx_msg.ksm_zc_cookies[1] = cookie;
113 /* move on to the next TX which can carry cookie */
114 ksocknal_next_tx_carrier(conn);
115
116 return 1;
117 }
118
119 static ksock_tx_t *
120 ksocknal_queue_tx_msg_v2(ksock_conn_t *conn, ksock_tx_t *tx_msg)
121 {
122 ksock_tx_t *tx = conn->ksnc_tx_carrier;
123
124 /*
125 * Enqueue tx_msg:
126 * . If there is no NOOP on the connection, just enqueue
127 * tx_msg and return NULL
128 * . If there is NOOP on the connection, piggyback the cookie
129 * and replace the NOOP tx, and return the NOOP tx.
130 */
131 if (tx == NULL) { /* nothing on queue */
132 list_add_tail(&tx_msg->tx_list, &conn->ksnc_tx_queue);
133 conn->ksnc_tx_carrier = tx_msg;
134 return NULL;
135 }
136
137 if (tx->tx_msg.ksm_type == KSOCK_MSG_LNET) { /* nothing to carry */
138 list_add_tail(&tx_msg->tx_list, &conn->ksnc_tx_queue);
139 return NULL;
140 }
141
142 LASSERT (tx->tx_msg.ksm_type == KSOCK_MSG_NOOP);
143
144 /* There is a noop zc-ack can be piggybacked */
145 tx_msg->tx_msg.ksm_zc_cookies[1] = tx->tx_msg.ksm_zc_cookies[1];
146 ksocknal_next_tx_carrier(conn);
147
148 /* use new_tx to replace the noop zc-ack packet */
149 list_add(&tx_msg->tx_list, &tx->tx_list);
150 list_del(&tx->tx_list);
151
152 return tx;
153 }
154
155 static int
156 ksocknal_queue_tx_zcack_v3(ksock_conn_t *conn,
157 ksock_tx_t *tx_ack, __u64 cookie)
158 {
159 ksock_tx_t *tx;
160
161 if (conn->ksnc_type != SOCKLND_CONN_ACK)
162 return ksocknal_queue_tx_zcack_v2(conn, tx_ack, cookie);
163
164 /* non-blocking ZC-ACK (to router) */
165 LASSERT (tx_ack == NULL ||
166 tx_ack->tx_msg.ksm_type == KSOCK_MSG_NOOP);
167
168 tx = conn->ksnc_tx_carrier;
169 if (tx == NULL) {
170 if (tx_ack != NULL) {
171 list_add_tail(&tx_ack->tx_list,
172 &conn->ksnc_tx_queue);
173 conn->ksnc_tx_carrier = tx_ack;
174 }
175 return 0;
176 }
177
178 /* conn->ksnc_tx_carrier != NULL */
179
180 if (tx_ack != NULL)
181 cookie = tx_ack->tx_msg.ksm_zc_cookies[1];
182
183 if (cookie == SOCKNAL_KEEPALIVE_PING) /* ignore keepalive PING */
184 return 1;
185
186 if (tx->tx_msg.ksm_zc_cookies[1] == SOCKNAL_KEEPALIVE_PING) {
187 /* replace the keepalive PING with a real ACK */
188 LASSERT (tx->tx_msg.ksm_zc_cookies[0] == 0);
189 tx->tx_msg.ksm_zc_cookies[1] = cookie;
190 return 1;
191 }
192
193 if (cookie == tx->tx_msg.ksm_zc_cookies[0] ||
194 cookie == tx->tx_msg.ksm_zc_cookies[1]) {
195 CWARN("%s: duplicated ZC cookie: "LPU64"\n",
196 libcfs_id2str(conn->ksnc_peer->ksnp_id), cookie);
197 return 1; /* XXX return error in the future */
198 }
199
200 if (tx->tx_msg.ksm_zc_cookies[0] == 0) {
201 /* NOOP tx has only one ZC-ACK cookie, can carry at least one more */
202 if (tx->tx_msg.ksm_zc_cookies[1] > cookie) {
203 tx->tx_msg.ksm_zc_cookies[0] = tx->tx_msg.ksm_zc_cookies[1];
204 tx->tx_msg.ksm_zc_cookies[1] = cookie;
205 } else {
206 tx->tx_msg.ksm_zc_cookies[0] = cookie;
207 }
208
209 if (tx->tx_msg.ksm_zc_cookies[0] - tx->tx_msg.ksm_zc_cookies[1] > 2) {
210 /* not likely to carry more ACKs, skip it to simplify logic */
211 ksocknal_next_tx_carrier(conn);
212 }
213
214 return 1;
215 }
216
217 /* takes two or more cookies already */
218
219 if (tx->tx_msg.ksm_zc_cookies[0] > tx->tx_msg.ksm_zc_cookies[1]) {
220 __u64 tmp = 0;
221
222 /* two separated cookies: (a+2, a) or (a+1, a) */
223 LASSERT (tx->tx_msg.ksm_zc_cookies[0] -
224 tx->tx_msg.ksm_zc_cookies[1] <= 2);
225
226 if (tx->tx_msg.ksm_zc_cookies[0] -
227 tx->tx_msg.ksm_zc_cookies[1] == 2) {
228 if (cookie == tx->tx_msg.ksm_zc_cookies[1] + 1)
229 tmp = cookie;
230 } else if (cookie == tx->tx_msg.ksm_zc_cookies[1] - 1) {
231 tmp = tx->tx_msg.ksm_zc_cookies[1];
232 } else if (cookie == tx->tx_msg.ksm_zc_cookies[0] + 1) {
233 tmp = tx->tx_msg.ksm_zc_cookies[0];
234 }
235
236 if (tmp != 0) {
237 /* range of cookies */
238 tx->tx_msg.ksm_zc_cookies[0] = tmp - 1;
239 tx->tx_msg.ksm_zc_cookies[1] = tmp + 1;
240 return 1;
241 }
242
243 } else {
244 /* ksm_zc_cookies[0] < ksm_zc_cookies[1], it is range of cookies */
245 if (cookie >= tx->tx_msg.ksm_zc_cookies[0] &&
246 cookie <= tx->tx_msg.ksm_zc_cookies[1]) {
247 CWARN("%s: duplicated ZC cookie: "LPU64"\n",
248 libcfs_id2str(conn->ksnc_peer->ksnp_id), cookie);
249 return 1; /* XXX: return error in the future */
250 }
251
252 if (cookie == tx->tx_msg.ksm_zc_cookies[1] + 1) {
253 tx->tx_msg.ksm_zc_cookies[1] = cookie;
254 return 1;
255 }
256
257 if (cookie == tx->tx_msg.ksm_zc_cookies[0] - 1) {
258 tx->tx_msg.ksm_zc_cookies[0] = cookie;
259 return 1;
260 }
261 }
262
263 /* failed to piggyback ZC-ACK */
264 if (tx_ack != NULL) {
265 list_add_tail(&tx_ack->tx_list, &conn->ksnc_tx_queue);
266 /* the next tx can piggyback at least 1 ACK */
267 ksocknal_next_tx_carrier(conn);
268 }
269
270 return 0;
271 }
272
273 static int
274 ksocknal_match_tx(ksock_conn_t *conn, ksock_tx_t *tx, int nonblk)
275 {
276 int nob;
277
278 #if SOCKNAL_VERSION_DEBUG
279 if (!*ksocknal_tunables.ksnd_typed_conns)
280 return SOCKNAL_MATCH_YES;
281 #endif
282
283 if (tx == NULL || tx->tx_lnetmsg == NULL) {
284 /* noop packet */
285 nob = offsetof(ksock_msg_t, ksm_u);
286 } else {
287 nob = tx->tx_lnetmsg->msg_len +
288 ((conn->ksnc_proto == &ksocknal_protocol_v1x) ?
289 sizeof(lnet_hdr_t) : sizeof(ksock_msg_t));
290 }
291
292 /* default checking for typed connection */
293 switch (conn->ksnc_type) {
294 default:
295 CERROR("ksnc_type bad: %u\n", conn->ksnc_type);
296 LBUG();
297 case SOCKLND_CONN_ANY:
298 return SOCKNAL_MATCH_YES;
299
300 case SOCKLND_CONN_BULK_IN:
301 return SOCKNAL_MATCH_MAY;
302
303 case SOCKLND_CONN_BULK_OUT:
304 if (nob < *ksocknal_tunables.ksnd_min_bulk)
305 return SOCKNAL_MATCH_MAY;
306 else
307 return SOCKNAL_MATCH_YES;
308
309 case SOCKLND_CONN_CONTROL:
310 if (nob >= *ksocknal_tunables.ksnd_min_bulk)
311 return SOCKNAL_MATCH_MAY;
312 else
313 return SOCKNAL_MATCH_YES;
314 }
315 }
316
317 static int
318 ksocknal_match_tx_v3(ksock_conn_t *conn, ksock_tx_t *tx, int nonblk)
319 {
320 int nob;
321
322 if (tx == NULL || tx->tx_lnetmsg == NULL)
323 nob = offsetof(ksock_msg_t, ksm_u);
324 else
325 nob = tx->tx_lnetmsg->msg_len + sizeof(ksock_msg_t);
326
327 switch (conn->ksnc_type) {
328 default:
329 CERROR("ksnc_type bad: %u\n", conn->ksnc_type);
330 LBUG();
331 case SOCKLND_CONN_ANY:
332 return SOCKNAL_MATCH_NO;
333
334 case SOCKLND_CONN_ACK:
335 if (nonblk)
336 return SOCKNAL_MATCH_YES;
337 else if (tx == NULL || tx->tx_lnetmsg == NULL)
338 return SOCKNAL_MATCH_MAY;
339 else
340 return SOCKNAL_MATCH_NO;
341
342 case SOCKLND_CONN_BULK_OUT:
343 if (nonblk)
344 return SOCKNAL_MATCH_NO;
345 else if (nob < *ksocknal_tunables.ksnd_min_bulk)
346 return SOCKNAL_MATCH_MAY;
347 else
348 return SOCKNAL_MATCH_YES;
349
350 case SOCKLND_CONN_CONTROL:
351 if (nonblk)
352 return SOCKNAL_MATCH_NO;
353 else if (nob >= *ksocknal_tunables.ksnd_min_bulk)
354 return SOCKNAL_MATCH_MAY;
355 else
356 return SOCKNAL_MATCH_YES;
357 }
358 }
359
360 /* (Sink) handle incoming ZC request from sender */
361 static int
362 ksocknal_handle_zcreq(ksock_conn_t *c, __u64 cookie, int remote)
363 {
364 ksock_peer_t *peer = c->ksnc_peer;
365 ksock_conn_t *conn;
366 ksock_tx_t *tx;
367 int rc;
368
369 read_lock(&ksocknal_data.ksnd_global_lock);
370
371 conn = ksocknal_find_conn_locked(peer, NULL, !!remote);
372 if (conn != NULL) {
373 ksock_sched_t *sched = conn->ksnc_scheduler;
374
375 LASSERT(conn->ksnc_proto->pro_queue_tx_zcack != NULL);
376
377 spin_lock_bh(&sched->kss_lock);
378
379 rc = conn->ksnc_proto->pro_queue_tx_zcack(conn, NULL, cookie);
380
381 spin_unlock_bh(&sched->kss_lock);
382
383 if (rc) { /* piggybacked */
384 read_unlock(&ksocknal_data.ksnd_global_lock);
385 return 0;
386 }
387 }
388
389 read_unlock(&ksocknal_data.ksnd_global_lock);
390
391 /* ACK connection is not ready, or can't piggyback the ACK */
392 tx = ksocknal_alloc_tx_noop(cookie, !!remote);
393 if (tx == NULL)
394 return -ENOMEM;
395
396 rc = ksocknal_launch_packet(peer->ksnp_ni, tx, peer->ksnp_id);
397 if (rc == 0)
398 return 0;
399
400 ksocknal_free_tx(tx);
401 return rc;
402 }
403
404 /* (Sender) handle ZC_ACK from sink */
405 static int
406 ksocknal_handle_zcack(ksock_conn_t *conn, __u64 cookie1, __u64 cookie2)
407 {
408 ksock_peer_t *peer = conn->ksnc_peer;
409 ksock_tx_t *tx;
410 ksock_tx_t *tmp;
411 LIST_HEAD (zlist);
412 int count;
413
414 if (cookie1 == 0)
415 cookie1 = cookie2;
416
417 count = (cookie1 > cookie2) ? 2 : (cookie2 - cookie1 + 1);
418
419 if (cookie2 == SOCKNAL_KEEPALIVE_PING &&
420 conn->ksnc_proto == &ksocknal_protocol_v3x) {
421 /* keepalive PING for V3.x, just ignore it */
422 return count == 1 ? 0 : -EPROTO;
423 }
424
425 spin_lock(&peer->ksnp_lock);
426
427 list_for_each_entry_safe(tx, tmp,
428 &peer->ksnp_zc_req_list, tx_zc_list) {
429 __u64 c = tx->tx_msg.ksm_zc_cookies[0];
430
431 if (c == cookie1 || c == cookie2 || (cookie1 < c && c < cookie2)) {
432 tx->tx_msg.ksm_zc_cookies[0] = 0;
433 list_del(&tx->tx_zc_list);
434 list_add(&tx->tx_zc_list, &zlist);
435
436 if (--count == 0)
437 break;
438 }
439 }
440
441 spin_unlock(&peer->ksnp_lock);
442
443 while (!list_empty(&zlist)) {
444 tx = list_entry(zlist.next, ksock_tx_t, tx_zc_list);
445 list_del(&tx->tx_zc_list);
446 ksocknal_tx_decref(tx);
447 }
448
449 return count == 0 ? 0 : -EPROTO;
450 }
451
452 static int
453 ksocknal_send_hello_v1 (ksock_conn_t *conn, ksock_hello_msg_t *hello)
454 {
455 socket_t *sock = conn->ksnc_sock;
456 lnet_hdr_t *hdr;
457 lnet_magicversion_t *hmv;
458 int rc;
459 int i;
460
461 CLASSERT(sizeof(lnet_magicversion_t) == offsetof(lnet_hdr_t, src_nid));
462
463 LIBCFS_ALLOC(hdr, sizeof(*hdr));
464 if (hdr == NULL) {
465 CERROR("Can't allocate lnet_hdr_t\n");
466 return -ENOMEM;
467 }
468
469 hmv = (lnet_magicversion_t *)&hdr->dest_nid;
470
471 /* Re-organize V2.x message header to V1.x (lnet_hdr_t)
472 * header and send out */
473 hmv->magic = cpu_to_le32 (LNET_PROTO_TCP_MAGIC);
474 hmv->version_major = cpu_to_le16 (KSOCK_PROTO_V1_MAJOR);
475 hmv->version_minor = cpu_to_le16 (KSOCK_PROTO_V1_MINOR);
476
477 if (the_lnet.ln_testprotocompat != 0) {
478 /* single-shot proto check */
479 LNET_LOCK();
480 if ((the_lnet.ln_testprotocompat & 1) != 0) {
481 hmv->version_major++; /* just different! */
482 the_lnet.ln_testprotocompat &= ~1;
483 }
484 if ((the_lnet.ln_testprotocompat & 2) != 0) {
485 hmv->magic = LNET_PROTO_MAGIC;
486 the_lnet.ln_testprotocompat &= ~2;
487 }
488 LNET_UNLOCK();
489 }
490
491 hdr->src_nid = cpu_to_le64 (hello->kshm_src_nid);
492 hdr->src_pid = cpu_to_le32 (hello->kshm_src_pid);
493 hdr->type = cpu_to_le32 (LNET_MSG_HELLO);
494 hdr->payload_length = cpu_to_le32 (hello->kshm_nips * sizeof(__u32));
495 hdr->msg.hello.type = cpu_to_le32 (hello->kshm_ctype);
496 hdr->msg.hello.incarnation = cpu_to_le64 (hello->kshm_src_incarnation);
497
498 rc = libcfs_sock_write(sock, hdr, sizeof(*hdr),lnet_acceptor_timeout());
499
500 if (rc != 0) {
501 CNETERR("Error %d sending HELLO hdr to %pI4h/%d\n",
502 rc, &conn->ksnc_ipaddr, conn->ksnc_port);
503 goto out;
504 }
505
506 if (hello->kshm_nips == 0)
507 goto out;
508
509 for (i = 0; i < (int) hello->kshm_nips; i++) {
510 hello->kshm_ips[i] = __cpu_to_le32 (hello->kshm_ips[i]);
511 }
512
513 rc = libcfs_sock_write(sock, hello->kshm_ips,
514 hello->kshm_nips * sizeof(__u32),
515 lnet_acceptor_timeout());
516 if (rc != 0) {
517 CNETERR("Error %d sending HELLO payload (%d)"
518 " to %pI4h/%d\n", rc, hello->kshm_nips,
519 &conn->ksnc_ipaddr, conn->ksnc_port);
520 }
521 out:
522 LIBCFS_FREE(hdr, sizeof(*hdr));
523
524 return rc;
525 }
526
527 static int
528 ksocknal_send_hello_v2 (ksock_conn_t *conn, ksock_hello_msg_t *hello)
529 {
530 socket_t *sock = conn->ksnc_sock;
531 int rc;
532
533 hello->kshm_magic = LNET_PROTO_MAGIC;
534 hello->kshm_version = conn->ksnc_proto->pro_version;
535
536 if (the_lnet.ln_testprotocompat != 0) {
537 /* single-shot proto check */
538 LNET_LOCK();
539 if ((the_lnet.ln_testprotocompat & 1) != 0) {
540 hello->kshm_version++; /* just different! */
541 the_lnet.ln_testprotocompat &= ~1;
542 }
543 LNET_UNLOCK();
544 }
545
546 rc = libcfs_sock_write(sock, hello, offsetof(ksock_hello_msg_t, kshm_ips),
547 lnet_acceptor_timeout());
548
549 if (rc != 0) {
550 CNETERR("Error %d sending HELLO hdr to %pI4h/%d\n",
551 rc, &conn->ksnc_ipaddr, conn->ksnc_port);
552 return rc;
553 }
554
555 if (hello->kshm_nips == 0)
556 return 0;
557
558 rc = libcfs_sock_write(sock, hello->kshm_ips,
559 hello->kshm_nips * sizeof(__u32),
560 lnet_acceptor_timeout());
561 if (rc != 0) {
562 CNETERR("Error %d sending HELLO payload (%d)"
563 " to %pI4h/%d\n", rc, hello->kshm_nips,
564 &conn->ksnc_ipaddr, conn->ksnc_port);
565 }
566
567 return rc;
568 }
569
570 static int
571 ksocknal_recv_hello_v1(ksock_conn_t *conn, ksock_hello_msg_t *hello,int timeout)
572 {
573 socket_t *sock = conn->ksnc_sock;
574 lnet_hdr_t *hdr;
575 int rc;
576 int i;
577
578 LIBCFS_ALLOC(hdr, sizeof(*hdr));
579 if (hdr == NULL) {
580 CERROR("Can't allocate lnet_hdr_t\n");
581 return -ENOMEM;
582 }
583
584 rc = libcfs_sock_read(sock, &hdr->src_nid,
585 sizeof (*hdr) - offsetof (lnet_hdr_t, src_nid),
586 timeout);
587 if (rc != 0) {
588 CERROR("Error %d reading rest of HELLO hdr from %pI4h\n",
589 rc, &conn->ksnc_ipaddr);
590 LASSERT (rc < 0 && rc != -EALREADY);
591 goto out;
592 }
593
594 /* ...and check we got what we expected */
595 if (hdr->type != cpu_to_le32 (LNET_MSG_HELLO)) {
596 CERROR("Expecting a HELLO hdr,"
597 " but got type %d from %pI4h\n",
598 le32_to_cpu (hdr->type),
599 &conn->ksnc_ipaddr);
600 rc = -EPROTO;
601 goto out;
602 }
603
604 hello->kshm_src_nid = le64_to_cpu (hdr->src_nid);
605 hello->kshm_src_pid = le32_to_cpu (hdr->src_pid);
606 hello->kshm_src_incarnation = le64_to_cpu (hdr->msg.hello.incarnation);
607 hello->kshm_ctype = le32_to_cpu (hdr->msg.hello.type);
608 hello->kshm_nips = le32_to_cpu (hdr->payload_length) /
609 sizeof (__u32);
610
611 if (hello->kshm_nips > LNET_MAX_INTERFACES) {
612 CERROR("Bad nips %d from ip %pI4h\n",
613 hello->kshm_nips, &conn->ksnc_ipaddr);
614 rc = -EPROTO;
615 goto out;
616 }
617
618 if (hello->kshm_nips == 0)
619 goto out;
620
621 rc = libcfs_sock_read(sock, hello->kshm_ips,
622 hello->kshm_nips * sizeof(__u32), timeout);
623 if (rc != 0) {
624 CERROR("Error %d reading IPs from ip %pI4h\n",
625 rc, &conn->ksnc_ipaddr);
626 LASSERT(rc < 0 && rc != -EALREADY);
627 goto out;
628 }
629
630 for (i = 0; i < (int) hello->kshm_nips; i++) {
631 hello->kshm_ips[i] = __le32_to_cpu(hello->kshm_ips[i]);
632
633 if (hello->kshm_ips[i] == 0) {
634 CERROR("Zero IP[%d] from ip %pI4h\n",
635 i, &conn->ksnc_ipaddr);
636 rc = -EPROTO;
637 break;
638 }
639 }
640 out:
641 LIBCFS_FREE(hdr, sizeof(*hdr));
642
643 return rc;
644 }
645
646 static int
647 ksocknal_recv_hello_v2 (ksock_conn_t *conn, ksock_hello_msg_t *hello, int timeout)
648 {
649 socket_t *sock = conn->ksnc_sock;
650 int rc;
651 int i;
652
653 if (hello->kshm_magic == LNET_PROTO_MAGIC)
654 conn->ksnc_flip = 0;
655 else
656 conn->ksnc_flip = 1;
657
658 rc = libcfs_sock_read(sock, &hello->kshm_src_nid,
659 offsetof(ksock_hello_msg_t, kshm_ips) -
660 offsetof(ksock_hello_msg_t, kshm_src_nid),
661 timeout);
662 if (rc != 0) {
663 CERROR("Error %d reading HELLO from %pI4h\n",
664 rc, &conn->ksnc_ipaddr);
665 LASSERT(rc < 0 && rc != -EALREADY);
666 return rc;
667 }
668
669 if (conn->ksnc_flip) {
670 __swab32s(&hello->kshm_src_pid);
671 __swab64s(&hello->kshm_src_nid);
672 __swab32s(&hello->kshm_dst_pid);
673 __swab64s(&hello->kshm_dst_nid);
674 __swab64s(&hello->kshm_src_incarnation);
675 __swab64s(&hello->kshm_dst_incarnation);
676 __swab32s(&hello->kshm_ctype);
677 __swab32s(&hello->kshm_nips);
678 }
679
680 if (hello->kshm_nips > LNET_MAX_INTERFACES) {
681 CERROR("Bad nips %d from ip %pI4h\n",
682 hello->kshm_nips, &conn->ksnc_ipaddr);
683 return -EPROTO;
684 }
685
686 if (hello->kshm_nips == 0)
687 return 0;
688
689 rc = libcfs_sock_read(sock, hello->kshm_ips,
690 hello->kshm_nips * sizeof(__u32), timeout);
691 if (rc != 0) {
692 CERROR("Error %d reading IPs from ip %pI4h\n",
693 rc, &conn->ksnc_ipaddr);
694 LASSERT(rc < 0 && rc != -EALREADY);
695 return rc;
696 }
697
698 for (i = 0; i < (int) hello->kshm_nips; i++) {
699 if (conn->ksnc_flip)
700 __swab32s(&hello->kshm_ips[i]);
701
702 if (hello->kshm_ips[i] == 0) {
703 CERROR("Zero IP[%d] from ip %pI4h\n",
704 i, &conn->ksnc_ipaddr);
705 return -EPROTO;
706 }
707 }
708
709 return 0;
710 }
711
712 static void
713 ksocknal_pack_msg_v1(ksock_tx_t *tx)
714 {
715 /* V1.x has no KSOCK_MSG_NOOP */
716 LASSERT(tx->tx_msg.ksm_type != KSOCK_MSG_NOOP);
717 LASSERT(tx->tx_lnetmsg != NULL);
718
719 tx->tx_iov[0].iov_base = (void *)&tx->tx_lnetmsg->msg_hdr;
720 tx->tx_iov[0].iov_len = sizeof(lnet_hdr_t);
721
722 tx->tx_resid = tx->tx_nob = tx->tx_lnetmsg->msg_len + sizeof(lnet_hdr_t);
723 }
724
725 static void
726 ksocknal_pack_msg_v2(ksock_tx_t *tx)
727 {
728 tx->tx_iov[0].iov_base = (void *)&tx->tx_msg;
729
730 if (tx->tx_lnetmsg != NULL) {
731 LASSERT(tx->tx_msg.ksm_type != KSOCK_MSG_NOOP);
732
733 tx->tx_msg.ksm_u.lnetmsg.ksnm_hdr = tx->tx_lnetmsg->msg_hdr;
734 tx->tx_iov[0].iov_len = sizeof(ksock_msg_t);
735 tx->tx_resid = tx->tx_nob = sizeof(ksock_msg_t) + tx->tx_lnetmsg->msg_len;
736 } else {
737 LASSERT(tx->tx_msg.ksm_type == KSOCK_MSG_NOOP);
738
739 tx->tx_iov[0].iov_len = offsetof(ksock_msg_t, ksm_u.lnetmsg.ksnm_hdr);
740 tx->tx_resid = tx->tx_nob = offsetof(ksock_msg_t, ksm_u.lnetmsg.ksnm_hdr);
741 }
742 /* Don't checksum before start sending, because packet can be piggybacked with ACK */
743 }
744
745 static void
746 ksocknal_unpack_msg_v1(ksock_msg_t *msg)
747 {
748 msg->ksm_csum = 0;
749 msg->ksm_type = KSOCK_MSG_LNET;
750 msg->ksm_zc_cookies[0] = msg->ksm_zc_cookies[1] = 0;
751 }
752
753 static void
754 ksocknal_unpack_msg_v2(ksock_msg_t *msg)
755 {
756 return; /* Do nothing */
757 }
758
759 ksock_proto_t ksocknal_protocol_v1x =
760 {
761 .pro_version = KSOCK_PROTO_V1,
762 .pro_send_hello = ksocknal_send_hello_v1,
763 .pro_recv_hello = ksocknal_recv_hello_v1,
764 .pro_pack = ksocknal_pack_msg_v1,
765 .pro_unpack = ksocknal_unpack_msg_v1,
766 .pro_queue_tx_msg = ksocknal_queue_tx_msg_v1,
767 .pro_handle_zcreq = NULL,
768 .pro_handle_zcack = NULL,
769 .pro_queue_tx_zcack = NULL,
770 .pro_match_tx = ksocknal_match_tx
771 };
772
773 ksock_proto_t ksocknal_protocol_v2x =
774 {
775 .pro_version = KSOCK_PROTO_V2,
776 .pro_send_hello = ksocknal_send_hello_v2,
777 .pro_recv_hello = ksocknal_recv_hello_v2,
778 .pro_pack = ksocknal_pack_msg_v2,
779 .pro_unpack = ksocknal_unpack_msg_v2,
780 .pro_queue_tx_msg = ksocknal_queue_tx_msg_v2,
781 .pro_queue_tx_zcack = ksocknal_queue_tx_zcack_v2,
782 .pro_handle_zcreq = ksocknal_handle_zcreq,
783 .pro_handle_zcack = ksocknal_handle_zcack,
784 .pro_match_tx = ksocknal_match_tx
785 };
786
787 ksock_proto_t ksocknal_protocol_v3x =
788 {
789 .pro_version = KSOCK_PROTO_V3,
790 .pro_send_hello = ksocknal_send_hello_v2,
791 .pro_recv_hello = ksocknal_recv_hello_v2,
792 .pro_pack = ksocknal_pack_msg_v2,
793 .pro_unpack = ksocknal_unpack_msg_v2,
794 .pro_queue_tx_msg = ksocknal_queue_tx_msg_v2,
795 .pro_queue_tx_zcack = ksocknal_queue_tx_zcack_v3,
796 .pro_handle_zcreq = ksocknal_handle_zcreq,
797 .pro_handle_zcack = ksocknal_handle_zcack,
798 .pro_match_tx = ksocknal_match_tx_v3
799 };