Whamcloud - gitweb
LU-12678 lnet: use list_first_entry() in lnet/klnds subdirectory.
[fs/lustre-release.git] / lnet / klnds / socklnd / socklnd.c
1 /*
2  * GPL HEADER START
3  *
4  * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 only,
8  * as published by the Free Software Foundation.
9  *
10  * This program is distributed in the hope that it will be useful, but
11  * WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
13  * General Public License version 2 for more details (a copy is included
14  * in the LICENSE file that accompanied this code).
15  *
16  * You should have received a copy of the GNU General Public License
17  * version 2 along with this program; If not, see
18  * http://www.gnu.org/licenses/gpl-2.0.html
19  *
20  * GPL HEADER END
21  */
22 /*
23  * Copyright (c) 2003, 2010, Oracle and/or its affiliates. All rights reserved.
24  * Use is subject to license terms.
25  *
26  * Copyright (c) 2011, 2017, Intel Corporation.
27  */
28 /*
29  * This file is part of Lustre, http://www.lustre.org/
30  *
31  * lnet/klnds/socklnd/socklnd.c
32  *
33  * Author: Zach Brown <zab@zabbo.net>
34  * Author: Peter J. Braam <braam@clusterfs.com>
35  * Author: Phil Schwan <phil@clusterfs.com>
36  * Author: Eric Barton <eric@bartonsoftware.com>
37  */
38
39 #include <linux/inetdevice.h>
40 #include "socklnd.h"
41 #include <linux/sunrpc/addr.h>
42
43 static const struct lnet_lnd the_ksocklnd;
44 struct ksock_nal_data ksocknal_data;
45
46 static struct ksock_interface *
47 ksocknal_ip2iface(struct lnet_ni *ni, struct sockaddr *addr)
48 {
49         struct ksock_net *net = ni->ni_data;
50         struct ksock_interface *iface;
51
52         iface = &net->ksnn_interface;
53
54         if (rpc_cmp_addr((struct sockaddr *)&iface->ksni_addr, addr))
55                 return iface;
56
57         return NULL;
58 }
59
60 static struct ksock_interface *
61 ksocknal_index2iface(struct lnet_ni *ni, int index)
62 {
63         struct ksock_net *net = ni->ni_data;
64         struct ksock_interface *iface;
65
66         iface = &net->ksnn_interface;
67
68         if (iface->ksni_index == index)
69                 return iface;
70
71         return NULL;
72 }
73
74 static int ksocknal_ip2index(struct sockaddr *addr, struct lnet_ni *ni)
75 {
76         struct net_device *dev;
77         int ret = -1;
78         DECLARE_CONST_IN_IFADDR(ifa);
79
80         if (addr->sa_family != AF_INET)
81                 /* No IPv6 support yet */
82                 return ret;
83
84         rcu_read_lock();
85         for_each_netdev(ni->ni_net_ns, dev) {
86                 int flags = dev_get_flags(dev);
87                 struct in_device *in_dev;
88
89                 if (flags & IFF_LOOPBACK) /* skip the loopback IF */
90                         continue;
91
92                 if (!(flags & IFF_UP))
93                         continue;
94
95                 in_dev = __in_dev_get_rcu(dev);
96                 if (!in_dev)
97                         continue;
98
99                 in_dev_for_each_ifa_rcu(ifa, in_dev) {
100                         if (ifa->ifa_local ==
101                             ((struct sockaddr_in *)addr)->sin_addr.s_addr)
102                                 ret = dev->ifindex;
103                 }
104                 endfor_ifa(in_dev);
105                 if (ret >= 0)
106                         break;
107         }
108         rcu_read_unlock();
109
110         return ret;
111 }
112
113 static struct ksock_conn_cb *
114 ksocknal_create_conn_cb(struct sockaddr *addr)
115 {
116         struct ksock_conn_cb *conn_cb;
117
118         LIBCFS_ALLOC(conn_cb, sizeof(*conn_cb));
119         if (!conn_cb)
120                 return NULL;
121
122         refcount_set(&conn_cb->ksnr_refcount, 1);
123         conn_cb->ksnr_peer = NULL;
124         conn_cb->ksnr_retry_interval = 0;         /* OK to connect at any time */
125         rpc_copy_addr((struct sockaddr *)&conn_cb->ksnr_addr, addr);
126         rpc_set_port((struct sockaddr *)&conn_cb->ksnr_addr,
127                      rpc_get_port(addr));
128         conn_cb->ksnr_myiface = -1;
129         conn_cb->ksnr_scheduled = 0;
130         conn_cb->ksnr_connecting = 0;
131         conn_cb->ksnr_connected = 0;
132         conn_cb->ksnr_deleted = 0;
133         conn_cb->ksnr_conn_count = 0;
134         conn_cb->ksnr_ctrl_conn_count = 0;
135         conn_cb->ksnr_blki_conn_count = 0;
136         conn_cb->ksnr_blko_conn_count = 0;
137
138         return conn_cb;
139 }
140
141 void
142 ksocknal_destroy_conn_cb(struct ksock_conn_cb *conn_cb)
143 {
144         LASSERT(refcount_read(&conn_cb->ksnr_refcount) == 0);
145
146         if (conn_cb->ksnr_peer)
147                 ksocknal_peer_decref(conn_cb->ksnr_peer);
148
149         LIBCFS_FREE(conn_cb, sizeof(*conn_cb));
150 }
151
152 static struct ksock_peer_ni *
153 ksocknal_create_peer(struct lnet_ni *ni, struct lnet_process_id id)
154 {
155         int cpt = lnet_cpt_of_nid(id.nid, ni);
156         struct ksock_net *net = ni->ni_data;
157         struct ksock_peer_ni *peer_ni;
158
159         LASSERT(id.nid != LNET_NID_ANY);
160         LASSERT(id.pid != LNET_PID_ANY);
161         LASSERT(!in_interrupt());
162
163         if (!atomic_inc_unless_negative(&net->ksnn_npeers)) {
164                 CERROR("Can't create peer_ni: network shutdown\n");
165                 return ERR_PTR(-ESHUTDOWN);
166         }
167
168         LIBCFS_CPT_ALLOC(peer_ni, lnet_cpt_table(), cpt, sizeof(*peer_ni));
169         if (!peer_ni) {
170                 atomic_dec(&net->ksnn_npeers);
171                 return ERR_PTR(-ENOMEM);
172         }
173
174         peer_ni->ksnp_ni = ni;
175         peer_ni->ksnp_id = id;
176         refcount_set(&peer_ni->ksnp_refcount, 1); /* 1 ref for caller */
177         peer_ni->ksnp_closing = 0;
178         peer_ni->ksnp_accepting = 0;
179         peer_ni->ksnp_proto = NULL;
180         peer_ni->ksnp_last_alive = 0;
181         peer_ni->ksnp_zc_next_cookie = SOCKNAL_KEEPALIVE_PING + 1;
182         peer_ni->ksnp_conn_cb = NULL;
183
184         INIT_LIST_HEAD(&peer_ni->ksnp_conns);
185         INIT_LIST_HEAD(&peer_ni->ksnp_tx_queue);
186         INIT_LIST_HEAD(&peer_ni->ksnp_zc_req_list);
187         spin_lock_init(&peer_ni->ksnp_lock);
188
189         return peer_ni;
190 }
191
192 void
193 ksocknal_destroy_peer(struct ksock_peer_ni *peer_ni)
194 {
195         struct ksock_net *net = peer_ni->ksnp_ni->ni_data;
196
197         CDEBUG (D_NET, "peer_ni %s %p deleted\n",
198                 libcfs_id2str(peer_ni->ksnp_id), peer_ni);
199
200         LASSERT(refcount_read(&peer_ni->ksnp_refcount) == 0);
201         LASSERT(peer_ni->ksnp_accepting == 0);
202         LASSERT(list_empty(&peer_ni->ksnp_conns));
203         LASSERT(peer_ni->ksnp_conn_cb == NULL);
204         LASSERT(list_empty(&peer_ni->ksnp_tx_queue));
205         LASSERT(list_empty(&peer_ni->ksnp_zc_req_list));
206
207         LIBCFS_FREE(peer_ni, sizeof(*peer_ni));
208
209         /* NB a peer_ni's connections and conn_cb keep a reference on their
210          * peer_ni until they are destroyed, so we can be assured that _all_
211          * state to do with this peer_ni has been cleaned up when its refcount
212          * drops to zero.
213          */
214         if (atomic_dec_and_test(&net->ksnn_npeers))
215                 wake_up_var(&net->ksnn_npeers);
216 }
217
218 struct ksock_peer_ni *
219 ksocknal_find_peer_locked(struct lnet_ni *ni, struct lnet_process_id id)
220 {
221         struct ksock_peer_ni *peer_ni;
222
223         hash_for_each_possible(ksocknal_data.ksnd_peers, peer_ni,
224                                ksnp_list, id.nid) {
225                 LASSERT(!peer_ni->ksnp_closing);
226
227                 if (peer_ni->ksnp_ni != ni)
228                         continue;
229
230                 if (peer_ni->ksnp_id.nid != id.nid ||
231                     peer_ni->ksnp_id.pid != id.pid)
232                         continue;
233
234                 CDEBUG(D_NET, "got peer_ni [%p] -> %s (%d)\n",
235                        peer_ni, libcfs_id2str(id),
236                        refcount_read(&peer_ni->ksnp_refcount));
237                 return peer_ni;
238         }
239         return NULL;
240 }
241
242 struct ksock_peer_ni *
243 ksocknal_find_peer(struct lnet_ni *ni, struct lnet_process_id id)
244 {
245         struct ksock_peer_ni *peer_ni;
246
247         read_lock(&ksocknal_data.ksnd_global_lock);
248         peer_ni = ksocknal_find_peer_locked(ni, id);
249         if (peer_ni != NULL)                    /* +1 ref for caller? */
250                 ksocknal_peer_addref(peer_ni);
251         read_unlock(&ksocknal_data.ksnd_global_lock);
252
253         return (peer_ni);
254 }
255
256 static void
257 ksocknal_unlink_peer_locked(struct ksock_peer_ni *peer_ni)
258 {
259         int i;
260         struct ksock_interface *iface;
261
262         for (i = 0; i < peer_ni->ksnp_n_passive_ips; i++) {
263                 struct sockaddr_in sa = { .sin_family = AF_INET };
264                 LASSERT(i < LNET_INTERFACES_NUM);
265                 sa.sin_addr.s_addr = htonl(peer_ni->ksnp_passive_ips[i]);
266
267                 iface = ksocknal_ip2iface(peer_ni->ksnp_ni,
268                                           (struct sockaddr *)&sa);
269                 /*
270                  * All IPs in peer_ni->ksnp_passive_ips[] come from the
271                  * interface list, therefore the call must succeed.
272                  */
273                 LASSERT(iface != NULL);
274
275                 CDEBUG(D_NET, "peer_ni=%p iface=%p ksni_nroutes=%d\n",
276                        peer_ni, iface, iface->ksni_nroutes);
277                 iface->ksni_npeers--;
278         }
279
280         LASSERT(list_empty(&peer_ni->ksnp_conns));
281         LASSERT(peer_ni->ksnp_conn_cb == NULL);
282         LASSERT(!peer_ni->ksnp_closing);
283         peer_ni->ksnp_closing = 1;
284         hlist_del(&peer_ni->ksnp_list);
285         /* lose peerlist's ref */
286         ksocknal_peer_decref(peer_ni);
287 }
288
289 static int
290 ksocknal_get_peer_info(struct lnet_ni *ni, int index,
291                        struct lnet_process_id *id, __u32 *myip, __u32 *peer_ip,
292                        int *port, int *conn_count, int *share_count)
293 {
294         struct ksock_peer_ni *peer_ni;
295         struct ksock_conn_cb *conn_cb;
296         int i;
297         int j;
298         int rc = -ENOENT;
299
300         read_lock(&ksocknal_data.ksnd_global_lock);
301
302         hash_for_each(ksocknal_data.ksnd_peers, i, peer_ni, ksnp_list) {
303
304                 if (peer_ni->ksnp_ni != ni)
305                         continue;
306
307                 if (peer_ni->ksnp_n_passive_ips == 0 &&
308                     peer_ni->ksnp_conn_cb == NULL) {
309                         if (index-- > 0)
310                                 continue;
311
312                         *id = peer_ni->ksnp_id;
313                         *myip = 0;
314                         *peer_ip = 0;
315                         *port = 0;
316                         *conn_count = 0;
317                         *share_count = 0;
318                         rc = 0;
319                         goto out;
320                 }
321
322                 for (j = 0; j < peer_ni->ksnp_n_passive_ips; j++) {
323                         if (index-- > 0)
324                                 continue;
325
326                         *id = peer_ni->ksnp_id;
327                         *myip = peer_ni->ksnp_passive_ips[j];
328                         *peer_ip = 0;
329                         *port = 0;
330                         *conn_count = 0;
331                         *share_count = 0;
332                         rc = 0;
333                         goto out;
334                 }
335
336                 if (peer_ni->ksnp_conn_cb) {
337                         if (index-- > 0)
338                                 continue;
339
340                         conn_cb = peer_ni->ksnp_conn_cb;
341
342                         *id = peer_ni->ksnp_id;
343                         if (conn_cb->ksnr_addr.ss_family == AF_INET) {
344                                 struct sockaddr_in *sa =
345                                         (void *)&conn_cb->ksnr_addr;
346
347                                 rc = choose_ipv4_src(myip,
348                                                      conn_cb->ksnr_myiface,
349                                                      ntohl(sa->sin_addr.s_addr),
350                                                      ni->ni_net_ns);
351                                 *peer_ip = ntohl(sa->sin_addr.s_addr);
352                                 *port = ntohs(sa->sin_port);
353                         } else {
354                                 *myip = 0xFFFFFFFF;
355                                 *peer_ip = 0xFFFFFFFF;
356                                 *port = 0;
357                                 rc = -ENOTSUPP;
358                         }
359                         *conn_count = conn_cb->ksnr_conn_count;
360                         *share_count = 1;
361                         goto out;
362                 }
363         }
364 out:
365         read_unlock(&ksocknal_data.ksnd_global_lock);
366         return rc;
367 }
368
369 static unsigned int
370 ksocknal_get_conn_count_by_type(struct ksock_conn_cb *conn_cb,
371                                 int type)
372 {
373         unsigned int count = 0;
374
375         switch (type) {
376         case SOCKLND_CONN_CONTROL:
377                 count = conn_cb->ksnr_ctrl_conn_count;
378                 break;
379         case SOCKLND_CONN_BULK_IN:
380                 count = conn_cb->ksnr_blki_conn_count;
381                 break;
382         case SOCKLND_CONN_BULK_OUT:
383                 count = conn_cb->ksnr_blko_conn_count;
384                 break;
385         case SOCKLND_CONN_ANY:
386                 count = conn_cb->ksnr_conn_count;
387                 break;
388         default:
389                 LBUG();
390                 break;
391         }
392
393         return count;
394 }
395
396 static void
397 ksocknal_incr_conn_count(struct ksock_conn_cb *conn_cb,
398                          int type)
399 {
400         conn_cb->ksnr_conn_count++;
401
402         /* check if all connections of the given type got created */
403         switch (type) {
404         case SOCKLND_CONN_CONTROL:
405                 conn_cb->ksnr_ctrl_conn_count++;
406                 /* there's a single control connection per peer */
407                 conn_cb->ksnr_connected |= BIT(type);
408                 break;
409         case SOCKLND_CONN_BULK_IN:
410                 conn_cb->ksnr_blki_conn_count++;
411                 if (conn_cb->ksnr_blki_conn_count >=
412                     *ksocknal_tunables.ksnd_conns_per_peer)
413                         conn_cb->ksnr_connected |= BIT(type);
414                 break;
415         case SOCKLND_CONN_BULK_OUT:
416                 conn_cb->ksnr_blko_conn_count++;
417                 if (conn_cb->ksnr_blko_conn_count >=
418                     *ksocknal_tunables.ksnd_conns_per_peer)
419                         conn_cb->ksnr_connected |= BIT(type);
420                 break;
421         case SOCKLND_CONN_ANY:
422                 if (conn_cb->ksnr_conn_count >=
423                     *ksocknal_tunables.ksnd_conns_per_peer)
424                         conn_cb->ksnr_connected |= BIT(type);
425                 break;
426         default:
427                 LBUG();
428                 break;
429
430         }
431
432         CDEBUG(D_NET, "Add conn type %d, ksnr_connected %x conns_per_peer %d\n",
433                type, conn_cb->ksnr_connected, *ksocknal_tunables.ksnd_conns_per_peer);
434 }
435
436 static void
437 ksocknal_associate_cb_conn_locked(struct ksock_conn_cb *conn_cb,
438                                   struct ksock_conn *conn)
439 {
440         struct ksock_peer_ni *peer_ni = conn_cb->ksnr_peer;
441         int type = conn->ksnc_type;
442         struct ksock_interface *iface;
443         int conn_iface;
444
445         conn_iface = ksocknal_ip2index((struct sockaddr *)&conn->ksnc_myaddr,
446                                        peer_ni->ksnp_ni);
447         conn->ksnc_conn_cb = conn_cb;
448         ksocknal_conn_cb_addref(conn_cb);
449
450         if (conn_cb->ksnr_myiface != conn_iface) {
451                 if (conn_cb->ksnr_myiface < 0) {
452                         /* route wasn't bound locally yet (the initial route) */
453                         CDEBUG(D_NET, "Binding %s %pIS to interface %d\n",
454                                libcfs_id2str(peer_ni->ksnp_id),
455                                &conn_cb->ksnr_addr,
456                                conn_iface);
457                 } else {
458                         CDEBUG(D_NET,
459                                "Rebinding %s %pIS from interface %d to %d\n",
460                                libcfs_id2str(peer_ni->ksnp_id),
461                                &conn_cb->ksnr_addr,
462                                conn_cb->ksnr_myiface,
463                                conn_iface);
464
465                         iface = ksocknal_index2iface(peer_ni->ksnp_ni,
466                                                      conn_cb->ksnr_myiface);
467                         if (iface)
468                                 iface->ksni_nroutes--;
469                 }
470                 conn_cb->ksnr_myiface = conn_iface;
471                 iface = ksocknal_index2iface(peer_ni->ksnp_ni,
472                                              conn_cb->ksnr_myiface);
473                 if (iface)
474                         iface->ksni_nroutes++;
475         }
476
477         ksocknal_incr_conn_count(conn_cb, type);
478
479         /* Successful connection => further attempts can
480          * proceed immediately
481          */
482         conn_cb->ksnr_retry_interval = 0;
483 }
484
485 static void
486 ksocknal_add_conn_cb_locked(struct ksock_peer_ni *peer_ni,
487                             struct ksock_conn_cb *conn_cb)
488 {
489         struct list_head *tmp;
490         struct ksock_conn *conn;
491         struct ksock_net *net = peer_ni->ksnp_ni->ni_data;
492
493         LASSERT(!peer_ni->ksnp_closing);
494         LASSERT(!conn_cb->ksnr_peer);
495         LASSERT(!conn_cb->ksnr_scheduled);
496         LASSERT(!conn_cb->ksnr_connecting);
497         LASSERT(conn_cb->ksnr_connected == 0);
498
499         conn_cb->ksnr_peer = peer_ni;
500         ksocknal_peer_addref(peer_ni);
501
502         /* set the conn_cb's interface to the current net's interface */
503         conn_cb->ksnr_myiface = net->ksnn_interface.ksni_index;
504         net->ksnn_interface.ksni_nroutes++;
505
506         /* peer_ni's route list takes over my ref on 'route' */
507         peer_ni->ksnp_conn_cb = conn_cb;
508
509         list_for_each(tmp, &peer_ni->ksnp_conns) {
510                 conn = list_entry(tmp, struct ksock_conn, ksnc_list);
511
512                 if (!rpc_cmp_addr((struct sockaddr *)&conn->ksnc_peeraddr,
513                                   (struct sockaddr *)&conn_cb->ksnr_addr))
514                         continue;
515
516                 ksocknal_associate_cb_conn_locked(conn_cb, conn);
517                 /* keep going (typed conns) */
518         }
519 }
520
521 static void
522 ksocknal_del_conn_cb_locked(struct ksock_conn_cb *conn_cb)
523 {
524         struct ksock_peer_ni *peer_ni = conn_cb->ksnr_peer;
525         struct ksock_interface *iface;
526         struct ksock_conn *conn;
527         struct ksock_conn *cnxt;
528
529         LASSERT(!conn_cb->ksnr_deleted);
530
531         /* Close associated conns */
532         list_for_each_entry_safe(conn, cnxt, &peer_ni->ksnp_conns, ksnc_list) {
533                 if (conn->ksnc_conn_cb != conn_cb)
534                         continue;
535
536                 ksocknal_close_conn_locked(conn, 0);
537         }
538
539         if (conn_cb->ksnr_myiface >= 0) {
540                 iface = ksocknal_index2iface(peer_ni->ksnp_ni,
541                                              conn_cb->ksnr_myiface);
542                 if (iface)
543                         iface->ksni_nroutes--;
544         }
545
546         conn_cb->ksnr_deleted = 1;
547         ksocknal_conn_cb_decref(conn_cb);               /* drop peer_ni's ref */
548         peer_ni->ksnp_conn_cb = NULL;
549
550         if (list_empty(&peer_ni->ksnp_conns)) {
551                 /* I've just removed the last route to a peer_ni with no active
552                  * connections
553                  */
554                 ksocknal_unlink_peer_locked(peer_ni);
555         }
556 }
557
558 int
559 ksocknal_add_peer(struct lnet_ni *ni, struct lnet_process_id id,
560                   struct sockaddr *addr)
561 {
562         struct ksock_peer_ni *peer_ni;
563         struct ksock_peer_ni *peer2;
564         struct ksock_conn_cb *conn_cb;
565
566         if (id.nid == LNET_NID_ANY ||
567             id.pid == LNET_PID_ANY)
568                 return (-EINVAL);
569
570         /* Have a brand new peer_ni ready... */
571         peer_ni = ksocknal_create_peer(ni, id);
572         if (IS_ERR(peer_ni))
573                 return PTR_ERR(peer_ni);
574
575         conn_cb = ksocknal_create_conn_cb(addr);
576         if (!conn_cb) {
577                 ksocknal_peer_decref(peer_ni);
578                 return -ENOMEM;
579         }
580
581         write_lock_bh(&ksocknal_data.ksnd_global_lock);
582
583         /* always called with a ref on ni, so shutdown can't have started */
584         LASSERT(atomic_read(&((struct ksock_net *)ni->ni_data)->ksnn_npeers)
585                 >= 0);
586
587         peer2 = ksocknal_find_peer_locked(ni, id);
588         if (peer2 != NULL) {
589                 ksocknal_peer_decref(peer_ni);
590                 peer_ni = peer2;
591         } else {
592                 /* peer_ni table takes my ref on peer_ni */
593                 hash_add(ksocknal_data.ksnd_peers, &peer_ni->ksnp_list, id.nid);
594         }
595
596         ksocknal_add_conn_cb_locked(peer_ni, conn_cb);
597
598         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
599
600         return 0;
601 }
602
603 static void
604 ksocknal_del_peer_locked(struct ksock_peer_ni *peer_ni, __u32 ip)
605 {
606         struct ksock_conn *conn;
607         struct ksock_conn *cnxt;
608         struct ksock_conn_cb *conn_cb;
609
610         LASSERT(!peer_ni->ksnp_closing);
611
612         /* Extra ref prevents peer_ni disappearing until I'm done with it */
613         ksocknal_peer_addref(peer_ni);
614         conn_cb = peer_ni->ksnp_conn_cb;
615         if (conn_cb)
616                 ksocknal_del_conn_cb_locked(conn_cb);
617
618         list_for_each_entry_safe(conn, cnxt, &peer_ni->ksnp_conns,
619                                  ksnc_list)
620                 ksocknal_close_conn_locked(conn, 0);
621
622         ksocknal_peer_decref(peer_ni);
623         /* NB peer_ni unlinks itself when last conn/conn_cb is removed */
624 }
625
626 static int
627 ksocknal_del_peer(struct lnet_ni *ni, struct lnet_process_id id, __u32 ip)
628 {
629         LIST_HEAD(zombies);
630         struct hlist_node *pnxt;
631         struct ksock_peer_ni *peer_ni;
632         int lo;
633         int hi;
634         int i;
635         int rc = -ENOENT;
636
637         write_lock_bh(&ksocknal_data.ksnd_global_lock);
638
639         if (id.nid != LNET_NID_ANY) {
640                 lo = hash_min(id.nid, HASH_BITS(ksocknal_data.ksnd_peers));
641                 hi = lo;
642         } else {
643                 lo = 0;
644                 hi = HASH_SIZE(ksocknal_data.ksnd_peers) - 1;
645         }
646
647         for (i = lo; i <= hi; i++) {
648                 hlist_for_each_entry_safe(peer_ni, pnxt,
649                                           &ksocknal_data.ksnd_peers[i],
650                                           ksnp_list) {
651                         if (peer_ni->ksnp_ni != ni)
652                                 continue;
653
654                         if (!((id.nid == LNET_NID_ANY ||
655                                peer_ni->ksnp_id.nid == id.nid) &&
656                               (id.pid == LNET_PID_ANY ||
657                                peer_ni->ksnp_id.pid == id.pid)))
658                                 continue;
659
660                         ksocknal_peer_addref(peer_ni);  /* a ref for me... */
661
662                         ksocknal_del_peer_locked(peer_ni, ip);
663
664                         if (peer_ni->ksnp_closing &&
665                             !list_empty(&peer_ni->ksnp_tx_queue)) {
666                                 LASSERT(list_empty(&peer_ni->ksnp_conns));
667                                 LASSERT(peer_ni->ksnp_conn_cb == NULL);
668
669                                 list_splice_init(&peer_ni->ksnp_tx_queue,
670                                                  &zombies);
671                         }
672
673                         ksocknal_peer_decref(peer_ni);  /* ...till here */
674
675                         rc = 0;                         /* matched! */
676                 }
677         }
678
679         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
680
681         ksocknal_txlist_done(ni, &zombies, -ENETDOWN);
682
683         return rc;
684 }
685
686 static struct ksock_conn *
687 ksocknal_get_conn_by_idx(struct lnet_ni *ni, int index)
688 {
689         struct ksock_peer_ni *peer_ni;
690         struct ksock_conn *conn;
691         struct list_head *ctmp;
692         int i;
693
694         read_lock(&ksocknal_data.ksnd_global_lock);
695
696         hash_for_each(ksocknal_data.ksnd_peers, i, peer_ni, ksnp_list) {
697                 LASSERT(!peer_ni->ksnp_closing);
698
699                 if (peer_ni->ksnp_ni != ni)
700                         continue;
701
702                 list_for_each(ctmp, &peer_ni->ksnp_conns) {
703                         if (index-- > 0)
704                                 continue;
705
706                         conn = list_entry(ctmp, struct ksock_conn,
707                                           ksnc_list);
708                         ksocknal_conn_addref(conn);
709                         read_unlock(&ksocknal_data.ksnd_global_lock);
710                         return conn;
711                 }
712         }
713
714         read_unlock(&ksocknal_data.ksnd_global_lock);
715         return NULL;
716 }
717
718 static struct ksock_sched *
719 ksocknal_choose_scheduler_locked(unsigned int cpt)
720 {
721         struct ksock_sched *sched = ksocknal_data.ksnd_schedulers[cpt];
722         int i;
723
724         if (sched->kss_nthreads == 0) {
725                 cfs_percpt_for_each(sched, i, ksocknal_data.ksnd_schedulers) {
726                         if (sched->kss_nthreads > 0) {
727                                 CDEBUG(D_NET, "scheduler[%d] has no threads. selected scheduler[%d]\n",
728                                        cpt, sched->kss_cpt);
729                                 return sched;
730                         }
731                 }
732                 return NULL;
733         }
734
735         return sched;
736 }
737
738 int
739 ksocknal_accept(struct lnet_ni *ni, struct socket *sock)
740 {
741         struct ksock_connreq *cr;
742         int rc;
743         struct sockaddr_storage peer;
744
745         rc = lnet_sock_getaddr(sock, true, &peer);
746         LASSERT(rc == 0);               /* we succeeded before */
747
748         LIBCFS_ALLOC(cr, sizeof(*cr));
749         if (cr == NULL) {
750                 LCONSOLE_ERROR_MSG(0x12f,
751                                    "Dropping connection request from %pIS: memory exhausted\n",
752                                    &peer);
753                 return -ENOMEM;
754         }
755
756         lnet_ni_addref(ni);
757         cr->ksncr_ni   = ni;
758         cr->ksncr_sock = sock;
759
760         spin_lock_bh(&ksocknal_data.ksnd_connd_lock);
761
762         list_add_tail(&cr->ksncr_list, &ksocknal_data.ksnd_connd_connreqs);
763         wake_up(&ksocknal_data.ksnd_connd_waitq);
764
765         spin_unlock_bh(&ksocknal_data.ksnd_connd_lock);
766         return 0;
767 }
768
769 static int
770 ksocknal_connecting(struct ksock_conn_cb *conn_cb, struct sockaddr *sa)
771 {
772         if (conn_cb &&
773             rpc_cmp_addr((struct sockaddr *)&conn_cb->ksnr_addr, sa))
774                 return conn_cb->ksnr_connecting;
775         return 0;
776 }
777
778 int
779 ksocknal_create_conn(struct lnet_ni *ni, struct ksock_conn_cb *conn_cb,
780                      struct socket *sock, int type)
781 {
782         rwlock_t *global_lock = &ksocknal_data.ksnd_global_lock;
783         LIST_HEAD(zombies);
784         struct lnet_process_id peerid;
785         struct list_head *tmp;
786         u64 incarnation;
787         struct ksock_conn *conn;
788         struct ksock_conn *conn2;
789         struct ksock_peer_ni *peer_ni = NULL;
790         struct ksock_peer_ni *peer2;
791         struct ksock_sched *sched;
792         struct ksock_hello_msg *hello;
793         int cpt;
794         struct ksock_tx *tx;
795         struct ksock_tx *txtmp;
796         int rc;
797         int rc2;
798         int active;
799         int num_dup = 0;
800         char *warn = NULL;
801
802         active = (conn_cb != NULL);
803
804         LASSERT(active == (type != SOCKLND_CONN_NONE));
805
806         LIBCFS_ALLOC(conn, sizeof(*conn));
807         if (conn == NULL) {
808                 rc = -ENOMEM;
809                 goto failed_0;
810         }
811
812         conn->ksnc_peer = NULL;
813         conn->ksnc_conn_cb = NULL;
814         conn->ksnc_sock = sock;
815         /* 2 ref, 1 for conn, another extra ref prevents socket
816          * being closed before establishment of connection */
817         refcount_set(&conn->ksnc_sock_refcount, 2);
818         conn->ksnc_type = type;
819         ksocknal_lib_save_callback(sock, conn);
820         refcount_set(&conn->ksnc_conn_refcount, 1); /* 1 ref for me */
821
822         conn->ksnc_rx_ready = 0;
823         conn->ksnc_rx_scheduled = 0;
824
825         INIT_LIST_HEAD(&conn->ksnc_tx_queue);
826         conn->ksnc_tx_ready = 0;
827         conn->ksnc_tx_scheduled = 0;
828         conn->ksnc_tx_carrier = NULL;
829         atomic_set (&conn->ksnc_tx_nob, 0);
830
831         LIBCFS_ALLOC(hello, offsetof(struct ksock_hello_msg,
832                                      kshm_ips[LNET_INTERFACES_NUM]));
833         if (hello == NULL) {
834                 rc = -ENOMEM;
835                 goto failed_1;
836         }
837
838         /* stash conn's local and remote addrs */
839         rc = ksocknal_lib_get_conn_addrs(conn);
840         if (rc != 0)
841                 goto failed_1;
842
843         /* Find out/confirm peer_ni's NID and connection type and get the
844          * vector of interfaces she's willing to let me connect to.
845          * Passive connections use the listener timeout since the peer_ni sends
846          * eagerly
847          */
848
849         if (active) {
850                 peer_ni = conn_cb->ksnr_peer;
851                 LASSERT(ni == peer_ni->ksnp_ni);
852
853                 /* Active connection sends HELLO eagerly */
854                 hello->kshm_nips = 0;
855                 peerid = peer_ni->ksnp_id;
856
857                 write_lock_bh(global_lock);
858                 conn->ksnc_proto = peer_ni->ksnp_proto;
859                 write_unlock_bh(global_lock);
860
861                 if (conn->ksnc_proto == NULL) {
862                         conn->ksnc_proto = &ksocknal_protocol_v3x;
863 #if SOCKNAL_VERSION_DEBUG
864                         if (*ksocknal_tunables.ksnd_protocol == 2)
865                                 conn->ksnc_proto = &ksocknal_protocol_v2x;
866                         else if (*ksocknal_tunables.ksnd_protocol == 1)
867                                 conn->ksnc_proto = &ksocknal_protocol_v1x;
868 #endif
869                 }
870
871                 rc = ksocknal_send_hello(ni, conn, peerid.nid, hello);
872                 if (rc != 0)
873                         goto failed_1;
874         } else {
875                 peerid.nid = LNET_NID_ANY;
876                 peerid.pid = LNET_PID_ANY;
877
878                 /* Passive, get protocol from peer_ni */
879                 conn->ksnc_proto = NULL;
880         }
881
882         rc = ksocknal_recv_hello(ni, conn, hello, &peerid, &incarnation);
883         if (rc < 0)
884                 goto failed_1;
885
886         LASSERT(rc == 0 || active);
887         LASSERT(conn->ksnc_proto != NULL);
888         LASSERT(peerid.nid != LNET_NID_ANY);
889
890         cpt = lnet_cpt_of_nid(peerid.nid, ni);
891
892         if (active) {
893                 ksocknal_peer_addref(peer_ni);
894                 write_lock_bh(global_lock);
895         } else {
896                 peer_ni = ksocknal_create_peer(ni, peerid);
897                 if (IS_ERR(peer_ni)) {
898                         rc = PTR_ERR(peer_ni);
899                         goto failed_1;
900                 }
901
902                 write_lock_bh(global_lock);
903
904                 /* called with a ref on ni, so shutdown can't have started */
905                 LASSERT(atomic_read(&((struct ksock_net *)ni->ni_data)->ksnn_npeers) >= 0);
906
907                 peer2 = ksocknal_find_peer_locked(ni, peerid);
908                 if (peer2 == NULL) {
909                         /* NB this puts an "empty" peer_ni in the peer_ni
910                          * table (which takes my ref) */
911                         hash_add(ksocknal_data.ksnd_peers,
912                                  &peer_ni->ksnp_list, peerid.nid);
913                 } else {
914                         ksocknal_peer_decref(peer_ni);
915                         peer_ni = peer2;
916                 }
917
918                 /* +1 ref for me */
919                 ksocknal_peer_addref(peer_ni);
920                 peer_ni->ksnp_accepting++;
921
922                 /* Am I already connecting to this guy?  Resolve in
923                  * favour of higher NID...
924                  */
925                 if (peerid.nid < ni->ni_nid &&
926                     ksocknal_connecting(peer_ni->ksnp_conn_cb,
927                                         ((struct sockaddr *) &conn->ksnc_peeraddr))) {
928                         rc = EALREADY;
929                         warn = "connection race resolution";
930                         goto failed_2;
931                 }
932         }
933
934         if (peer_ni->ksnp_closing ||
935             (active && conn_cb->ksnr_deleted)) {
936                 /* peer_ni/conn_cb got closed under me */
937                 rc = -ESTALE;
938                 warn = "peer_ni/conn_cb removed";
939                 goto failed_2;
940         }
941
942         if (peer_ni->ksnp_proto == NULL) {
943                 /* Never connected before.
944                  * NB recv_hello may have returned EPROTO to signal my peer_ni
945                  * wants a different protocol than the one I asked for.
946                  */
947                 LASSERT(list_empty(&peer_ni->ksnp_conns));
948
949                 peer_ni->ksnp_proto = conn->ksnc_proto;
950                 peer_ni->ksnp_incarnation = incarnation;
951         }
952
953         if (peer_ni->ksnp_proto != conn->ksnc_proto ||
954             peer_ni->ksnp_incarnation != incarnation) {
955                 /* peer_ni rebooted or I've got the wrong protocol version */
956                 ksocknal_close_peer_conns_locked(peer_ni, NULL, 0);
957
958                 peer_ni->ksnp_proto = NULL;
959                 rc = ESTALE;
960                 warn = peer_ni->ksnp_incarnation != incarnation ?
961                         "peer_ni rebooted" :
962                         "wrong proto version";
963                 goto failed_2;
964         }
965
966         switch (rc) {
967         default:
968                 LBUG();
969         case 0:
970                 break;
971         case EALREADY:
972                 warn = "lost conn race";
973                 goto failed_2;
974         case EPROTO:
975                 warn = "retry with different protocol version";
976                 goto failed_2;
977         }
978
979         /* Refuse to duplicate an existing connection, unless this is a
980          * loopback connection */
981         if (!rpc_cmp_addr((struct sockaddr *)&conn->ksnc_peeraddr,
982                           (struct sockaddr *)&conn->ksnc_myaddr)) {
983                 list_for_each(tmp, &peer_ni->ksnp_conns) {
984                         conn2 = list_entry(tmp, struct ksock_conn, ksnc_list);
985
986                         if (!rpc_cmp_addr(
987                                     (struct sockaddr *)&conn2->ksnc_peeraddr,
988                                     (struct sockaddr *)&conn->ksnc_peeraddr) ||
989                             !rpc_cmp_addr(
990                                     (struct sockaddr *)&conn2->ksnc_myaddr,
991                                     (struct sockaddr *)&conn->ksnc_myaddr) ||
992                             conn2->ksnc_type != conn->ksnc_type)
993                                 continue;
994
995                         num_dup++;
996                         if (num_dup < *ksocknal_tunables.ksnd_conns_per_peer)
997                                 continue;
998
999                         /* Reply on a passive connection attempt so the peer_ni
1000                          * realises we're connected.
1001                          */
1002                         LASSERT(rc == 0);
1003                         if (!active)
1004                                 rc = EALREADY;
1005
1006                         warn = "duplicate";
1007                         goto failed_2;
1008                 }
1009         }
1010         /* If the connection created by this route didn't bind to the IP
1011          * address the route connected to, the connection/route matching
1012          * code below probably isn't going to work.
1013          */
1014         if (active &&
1015             !rpc_cmp_addr((struct sockaddr *)&conn_cb->ksnr_addr,
1016                           (struct sockaddr *)&conn->ksnc_peeraddr)) {
1017                 CERROR("Route %s %pIS connected to %pIS\n",
1018                        libcfs_id2str(peer_ni->ksnp_id),
1019                        &conn_cb->ksnr_addr,
1020                        &conn->ksnc_peeraddr);
1021         }
1022
1023         /* Search for a conn_cb corresponding to the new connection and
1024          * create an association.  This allows incoming connections created
1025          * by conn_cbs in my peer_ni to match my own conn_cb entries so I don't
1026          * continually create duplicate conn_cbs.
1027          */
1028         conn_cb = peer_ni->ksnp_conn_cb;
1029
1030         if (conn_cb && rpc_cmp_addr((struct sockaddr *)&conn->ksnc_peeraddr,
1031                                     (struct sockaddr *)&conn_cb->ksnr_addr))
1032                 ksocknal_associate_cb_conn_locked(conn_cb, conn);
1033
1034         conn->ksnc_peer = peer_ni;                 /* conn takes my ref on peer_ni */
1035         peer_ni->ksnp_last_alive = ktime_get_seconds();
1036         peer_ni->ksnp_send_keepalive = 0;
1037         peer_ni->ksnp_error = 0;
1038
1039         sched = ksocknal_choose_scheduler_locked(cpt);
1040         if (!sched) {
1041                 CERROR("no schedulers available. node is unhealthy\n");
1042                 goto failed_2;
1043         }
1044         /*
1045          * The cpt might have changed if we ended up selecting a non cpt
1046          * native scheduler. So use the scheduler's cpt instead.
1047          */
1048         cpt = sched->kss_cpt;
1049         sched->kss_nconns++;
1050         conn->ksnc_scheduler = sched;
1051
1052         conn->ksnc_tx_last_post = ktime_get_seconds();
1053         /* Set the deadline for the outgoing HELLO to drain */
1054         conn->ksnc_tx_bufnob = sock->sk->sk_wmem_queued;
1055         conn->ksnc_tx_deadline = ktime_get_seconds() +
1056                                  ksocknal_timeout();
1057         smp_mb();   /* order with adding to peer_ni's conn list */
1058
1059         list_add(&conn->ksnc_list, &peer_ni->ksnp_conns);
1060         ksocknal_conn_addref(conn);
1061
1062         ksocknal_new_packet(conn, 0);
1063
1064         conn->ksnc_zc_capable = ksocknal_lib_zc_capable(conn);
1065
1066         /* Take packets blocking for this connection. */
1067         list_for_each_entry_safe(tx, txtmp, &peer_ni->ksnp_tx_queue, tx_list) {
1068                 if (conn->ksnc_proto->pro_match_tx(conn, tx, tx->tx_nonblk) ==
1069                     SOCKNAL_MATCH_NO)
1070                         continue;
1071
1072                 list_del(&tx->tx_list);
1073                 ksocknal_queue_tx_locked(tx, conn);
1074         }
1075
1076         write_unlock_bh(global_lock);
1077
1078         /* We've now got a new connection.  Any errors from here on are just
1079          * like "normal" comms errors and we close the connection normally.
1080          * NB (a) we still have to send the reply HELLO for passive
1081          *        connections,
1082          *    (b) normal I/O on the conn is blocked until I setup and call the
1083          *        socket callbacks.
1084          */
1085
1086         CDEBUG(D_NET, "New conn %s p %d.x %pIS -> %pISp"
1087                " incarnation:%lld sched[%d]\n",
1088                libcfs_id2str(peerid), conn->ksnc_proto->pro_version,
1089                &conn->ksnc_myaddr, &conn->ksnc_peeraddr,
1090                incarnation, cpt);
1091
1092         if (!active) {
1093                 hello->kshm_nips = 0;
1094                 rc = ksocknal_send_hello(ni, conn, peerid.nid, hello);
1095         }
1096
1097         LIBCFS_FREE(hello, offsetof(struct ksock_hello_msg,
1098                                     kshm_ips[LNET_INTERFACES_NUM]));
1099
1100         /* setup the socket AFTER I've received hello (it disables
1101          * SO_LINGER).  I might call back to the acceptor who may want
1102          * to send a protocol version response and then close the
1103          * socket; this ensures the socket only tears down after the
1104          * response has been sent.
1105          */
1106         if (rc == 0)
1107                 rc = ksocknal_lib_setup_sock(sock);
1108
1109         write_lock_bh(global_lock);
1110
1111         /* NB my callbacks block while I hold ksnd_global_lock */
1112         ksocknal_lib_set_callback(sock, conn);
1113
1114         if (!active)
1115                 peer_ni->ksnp_accepting--;
1116
1117         write_unlock_bh(global_lock);
1118
1119         if (rc != 0) {
1120                 write_lock_bh(global_lock);
1121                 if (!conn->ksnc_closing) {
1122                         /* could be closed by another thread */
1123                         ksocknal_close_conn_locked(conn, rc);
1124                 }
1125                 write_unlock_bh(global_lock);
1126         } else if (ksocknal_connsock_addref(conn) == 0) {
1127                 /* Allow I/O to proceed. */
1128                 ksocknal_read_callback(conn);
1129                 ksocknal_write_callback(conn);
1130                 ksocknal_connsock_decref(conn);
1131         }
1132
1133         ksocknal_connsock_decref(conn);
1134         ksocknal_conn_decref(conn);
1135         return rc;
1136
1137 failed_2:
1138
1139         if (!peer_ni->ksnp_closing &&
1140             list_empty(&peer_ni->ksnp_conns) &&
1141             peer_ni->ksnp_conn_cb == NULL) {
1142                 list_splice_init(&peer_ni->ksnp_tx_queue, &zombies);
1143                 ksocknal_unlink_peer_locked(peer_ni);
1144         }
1145
1146         write_unlock_bh(global_lock);
1147
1148         if (warn != NULL) {
1149                 if (rc < 0)
1150                         CERROR("Not creating conn %s type %d: %s\n",
1151                                libcfs_id2str(peerid), conn->ksnc_type, warn);
1152                 else
1153                         CDEBUG(D_NET, "Not creating conn %s type %d: %s\n",
1154                                libcfs_id2str(peerid), conn->ksnc_type, warn);
1155         }
1156
1157         if (!active) {
1158                 if (rc > 0) {
1159                         /* Request retry by replying with CONN_NONE
1160                          * ksnc_proto has been set already
1161                          */
1162                         conn->ksnc_type = SOCKLND_CONN_NONE;
1163                         hello->kshm_nips = 0;
1164                         ksocknal_send_hello(ni, conn, peerid.nid, hello);
1165                 }
1166
1167                 write_lock_bh(global_lock);
1168                 peer_ni->ksnp_accepting--;
1169                 write_unlock_bh(global_lock);
1170         }
1171
1172         /*
1173          * If we get here without an error code, just use -EALREADY.
1174          * Depending on how we got here, the error may be positive
1175          * or negative. Normalize the value for ksocknal_txlist_done().
1176          */
1177         rc2 = (rc == 0 ? -EALREADY : (rc > 0 ? -rc : rc));
1178         ksocknal_txlist_done(ni, &zombies, rc2);
1179         ksocknal_peer_decref(peer_ni);
1180
1181 failed_1:
1182         if (hello != NULL)
1183                 LIBCFS_FREE(hello, offsetof(struct ksock_hello_msg,
1184                                             kshm_ips[LNET_INTERFACES_NUM]));
1185
1186         LIBCFS_FREE(conn, sizeof(*conn));
1187
1188 failed_0:
1189         sock_release(sock);
1190
1191         return rc;
1192 }
1193
1194 void
1195 ksocknal_close_conn_locked(struct ksock_conn *conn, int error)
1196 {
1197         /* This just does the immmediate housekeeping, and queues the
1198          * connection for the reaper to terminate.
1199          * Caller holds ksnd_global_lock exclusively in irq context */
1200         struct ksock_peer_ni *peer_ni = conn->ksnc_peer;
1201         struct ksock_conn_cb *conn_cb;
1202         struct ksock_conn *conn2;
1203         struct list_head *tmp;
1204
1205         LASSERT(peer_ni->ksnp_error == 0);
1206         LASSERT(!conn->ksnc_closing);
1207         conn->ksnc_closing = 1;
1208
1209         /* ksnd_deathrow_conns takes over peer_ni's ref */
1210         list_del(&conn->ksnc_list);
1211
1212         conn_cb = conn->ksnc_conn_cb;
1213         if (conn_cb != NULL) {
1214                 /* dissociate conn from cb... */
1215                 LASSERT(!conn_cb->ksnr_deleted);
1216
1217                 /* connected bit is set only if all connections
1218                  * of the given type got created
1219                  */
1220                 if (ksocknal_get_conn_count_by_type(conn_cb, conn->ksnc_type) ==
1221                     *ksocknal_tunables.ksnd_conns_per_peer)
1222                         LASSERT((conn_cb->ksnr_connected &
1223                                 BIT(conn->ksnc_type)) != 0);
1224
1225                 conn2 = NULL;
1226                 list_for_each(tmp, &peer_ni->ksnp_conns) {
1227                         conn2 = list_entry(tmp, struct ksock_conn, ksnc_list);
1228
1229                         if (conn2->ksnc_conn_cb == conn_cb &&
1230                             conn2->ksnc_type == conn->ksnc_type)
1231                                 break;
1232
1233                         conn2 = NULL;
1234                 }
1235                 if (conn2 == NULL)
1236                         conn_cb->ksnr_connected &= ~BIT(conn->ksnc_type);
1237
1238                 conn->ksnc_conn_cb = NULL;
1239
1240                 /* drop conn's ref on conn_cb */
1241                 ksocknal_conn_cb_decref(conn_cb);
1242         }
1243
1244         if (list_empty(&peer_ni->ksnp_conns)) {
1245                 /* No more connections to this peer_ni */
1246
1247                 if (!list_empty(&peer_ni->ksnp_tx_queue)) {
1248                         struct ksock_tx *tx;
1249
1250                         LASSERT(conn->ksnc_proto == &ksocknal_protocol_v3x);
1251
1252                         /* throw them to the last connection...,
1253                          * these TXs will be send to /dev/null by scheduler */
1254                         list_for_each_entry(tx, &peer_ni->ksnp_tx_queue,
1255                                             tx_list)
1256                                 ksocknal_tx_prep(conn, tx);
1257
1258                         spin_lock_bh(&conn->ksnc_scheduler->kss_lock);
1259                         list_splice_init(&peer_ni->ksnp_tx_queue,
1260                                          &conn->ksnc_tx_queue);
1261                         spin_unlock_bh(&conn->ksnc_scheduler->kss_lock);
1262                 }
1263
1264                 /* renegotiate protocol version */
1265                 peer_ni->ksnp_proto = NULL;
1266                 /* stash last conn close reason */
1267                 peer_ni->ksnp_error = error;
1268
1269                 if (peer_ni->ksnp_conn_cb == NULL) {
1270                         /* I've just closed last conn belonging to a
1271                          * peer_ni with no connections to it
1272                          */
1273                         ksocknal_unlink_peer_locked(peer_ni);
1274                 }
1275         }
1276
1277         spin_lock_bh(&ksocknal_data.ksnd_reaper_lock);
1278
1279         list_add_tail(&conn->ksnc_list, &ksocknal_data.ksnd_deathrow_conns);
1280         wake_up(&ksocknal_data.ksnd_reaper_waitq);
1281
1282         spin_unlock_bh(&ksocknal_data.ksnd_reaper_lock);
1283 }
1284
1285 void
1286 ksocknal_peer_failed(struct ksock_peer_ni *peer_ni)
1287 {
1288         bool notify = false;
1289         time64_t last_alive = 0;
1290
1291         /* There has been a connection failure or comms error; but I'll only
1292          * tell LNET I think the peer_ni is dead if it's to another kernel and
1293          * there are no connections or connection attempts in existence. */
1294
1295         read_lock(&ksocknal_data.ksnd_global_lock);
1296
1297         if ((peer_ni->ksnp_id.pid & LNET_PID_USERFLAG) == 0 &&
1298              list_empty(&peer_ni->ksnp_conns) &&
1299              peer_ni->ksnp_accepting == 0 &&
1300              !ksocknal_find_connecting_conn_cb_locked(peer_ni)) {
1301                 notify = true;
1302                 last_alive = peer_ni->ksnp_last_alive;
1303         }
1304
1305         read_unlock(&ksocknal_data.ksnd_global_lock);
1306
1307         if (notify)
1308                 lnet_notify(peer_ni->ksnp_ni, peer_ni->ksnp_id.nid,
1309                             false, false, last_alive);
1310 }
1311
1312 void
1313 ksocknal_finalize_zcreq(struct ksock_conn *conn)
1314 {
1315         struct ksock_peer_ni *peer_ni = conn->ksnc_peer;
1316         struct ksock_tx *tx;
1317         struct ksock_tx *tmp;
1318         LIST_HEAD(zlist);
1319
1320         /* NB safe to finalize TXs because closing of socket will
1321          * abort all buffered data */
1322         LASSERT(conn->ksnc_sock == NULL);
1323
1324         spin_lock(&peer_ni->ksnp_lock);
1325
1326         list_for_each_entry_safe(tx, tmp, &peer_ni->ksnp_zc_req_list, tx_zc_list) {
1327                 if (tx->tx_conn != conn)
1328                         continue;
1329
1330                 LASSERT(tx->tx_msg.ksm_zc_cookies[0] != 0);
1331
1332                 tx->tx_msg.ksm_zc_cookies[0] = 0;
1333                 tx->tx_zc_aborted = 1;  /* mark it as not-acked */
1334                 list_move(&tx->tx_zc_list, &zlist);
1335         }
1336
1337         spin_unlock(&peer_ni->ksnp_lock);
1338
1339         while ((tx = list_first_entry_or_null(&zlist, struct ksock_tx,
1340                                               tx_zc_list)) != NULL) {
1341                 list_del(&tx->tx_zc_list);
1342                 ksocknal_tx_decref(tx);
1343         }
1344 }
1345
1346 void
1347 ksocknal_terminate_conn(struct ksock_conn *conn)
1348 {
1349         /* This gets called by the reaper (guaranteed thread context) to
1350          * disengage the socket from its callbacks and close it.
1351          * ksnc_refcount will eventually hit zero, and then the reaper will
1352          * destroy it.
1353          */
1354         struct ksock_peer_ni *peer_ni = conn->ksnc_peer;
1355         struct ksock_sched *sched = conn->ksnc_scheduler;
1356         bool failed = false;
1357
1358         LASSERT(conn->ksnc_closing);
1359
1360         /* wake up the scheduler to "send" all remaining packets to /dev/null */
1361         spin_lock_bh(&sched->kss_lock);
1362
1363         /* a closing conn is always ready to tx */
1364         conn->ksnc_tx_ready = 1;
1365
1366         if (!conn->ksnc_tx_scheduled &&
1367             !list_empty(&conn->ksnc_tx_queue)) {
1368                 list_add_tail(&conn->ksnc_tx_list,
1369                               &sched->kss_tx_conns);
1370                 conn->ksnc_tx_scheduled = 1;
1371                 /* extra ref for scheduler */
1372                 ksocknal_conn_addref(conn);
1373
1374                 wake_up(&sched->kss_waitq);
1375         }
1376
1377         spin_unlock_bh(&sched->kss_lock);
1378
1379         /* serialise with callbacks */
1380         write_lock_bh(&ksocknal_data.ksnd_global_lock);
1381
1382         ksocknal_lib_reset_callback(conn->ksnc_sock, conn);
1383
1384         /* OK, so this conn may not be completely disengaged from its
1385          * scheduler yet, but it _has_ committed to terminate...
1386          */
1387         conn->ksnc_scheduler->kss_nconns--;
1388
1389         if (peer_ni->ksnp_error != 0) {
1390                 /* peer_ni's last conn closed in error */
1391                 LASSERT(list_empty(&peer_ni->ksnp_conns));
1392                 failed = true;
1393                 peer_ni->ksnp_error = 0;     /* avoid multiple notifications */
1394         }
1395
1396         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
1397
1398         if (failed)
1399                 ksocknal_peer_failed(peer_ni);
1400
1401         /* The socket is closed on the final put; either here, or in
1402          * ksocknal_{send,recv}msg().  Since we set up the linger2 option
1403          * when the connection was established, this will close the socket
1404          * immediately, aborting anything buffered in it. Any hung
1405          * zero-copy transmits will therefore complete in finite time.
1406          */
1407         ksocknal_connsock_decref(conn);
1408 }
1409
1410 void
1411 ksocknal_queue_zombie_conn(struct ksock_conn *conn)
1412 {
1413         /* Queue the conn for the reaper to destroy */
1414         LASSERT(refcount_read(&conn->ksnc_conn_refcount) == 0);
1415         spin_lock_bh(&ksocknal_data.ksnd_reaper_lock);
1416
1417         list_add_tail(&conn->ksnc_list, &ksocknal_data.ksnd_zombie_conns);
1418         wake_up(&ksocknal_data.ksnd_reaper_waitq);
1419
1420         spin_unlock_bh(&ksocknal_data.ksnd_reaper_lock);
1421 }
1422
1423 void
1424 ksocknal_destroy_conn(struct ksock_conn *conn)
1425 {
1426         time64_t last_rcv;
1427
1428         /* Final coup-de-grace of the reaper */
1429         CDEBUG(D_NET, "connection %p\n", conn);
1430
1431         LASSERT(refcount_read(&conn->ksnc_conn_refcount) == 0);
1432         LASSERT(refcount_read(&conn->ksnc_sock_refcount) == 0);
1433         LASSERT(conn->ksnc_sock == NULL);
1434         LASSERT(conn->ksnc_conn_cb == NULL);
1435         LASSERT(!conn->ksnc_tx_scheduled);
1436         LASSERT(!conn->ksnc_rx_scheduled);
1437         LASSERT(list_empty(&conn->ksnc_tx_queue));
1438
1439         /* complete current receive if any */
1440         switch (conn->ksnc_rx_state) {
1441         case SOCKNAL_RX_LNET_PAYLOAD:
1442                 last_rcv = conn->ksnc_rx_deadline -
1443                            ksocknal_timeout();
1444                 CERROR("Completing partial receive from %s[%d], ip %pISp, with error, wanted: %d, left: %d, last alive is %lld secs ago\n",
1445                        libcfs_id2str(conn->ksnc_peer->ksnp_id), conn->ksnc_type,
1446                        &conn->ksnc_peeraddr,
1447                        conn->ksnc_rx_nob_wanted, conn->ksnc_rx_nob_left,
1448                        ktime_get_seconds() - last_rcv);
1449                 if (conn->ksnc_lnet_msg)
1450                         conn->ksnc_lnet_msg->msg_health_status =
1451                                 LNET_MSG_STATUS_REMOTE_ERROR;
1452                 lnet_finalize(conn->ksnc_lnet_msg, -EIO);
1453                 break;
1454         case SOCKNAL_RX_LNET_HEADER:
1455                 if (conn->ksnc_rx_started)
1456                         CERROR("Incomplete receive of lnet header from %s, ip %pISp, with error, protocol: %d.x.\n",
1457                                libcfs_id2str(conn->ksnc_peer->ksnp_id),
1458                                &conn->ksnc_peeraddr,
1459                                conn->ksnc_proto->pro_version);
1460                 break;
1461         case SOCKNAL_RX_KSM_HEADER:
1462                 if (conn->ksnc_rx_started)
1463                         CERROR("Incomplete receive of ksock message from %s, ip %pISp, with error, protocol: %d.x.\n",
1464                                libcfs_id2str(conn->ksnc_peer->ksnp_id),
1465                                &conn->ksnc_peeraddr,
1466                                conn->ksnc_proto->pro_version);
1467                 break;
1468         case SOCKNAL_RX_SLOP:
1469                 if (conn->ksnc_rx_started)
1470                         CERROR("Incomplete receive of slops from %s, ip %pISp, with error\n",
1471                                libcfs_id2str(conn->ksnc_peer->ksnp_id),
1472                                &conn->ksnc_peeraddr);
1473                break;
1474         default:
1475                 LBUG ();
1476                 break;
1477         }
1478
1479         ksocknal_peer_decref(conn->ksnc_peer);
1480
1481         LIBCFS_FREE (conn, sizeof (*conn));
1482 }
1483
1484 int
1485 ksocknal_close_peer_conns_locked(struct ksock_peer_ni *peer_ni,
1486                                  struct sockaddr *addr, int why)
1487 {
1488         struct ksock_conn *conn;
1489         struct ksock_conn *cnxt;
1490         int count = 0;
1491
1492         list_for_each_entry_safe(conn, cnxt, &peer_ni->ksnp_conns, ksnc_list) {
1493                 if (!addr ||
1494                     rpc_cmp_addr(addr,
1495                                  (struct sockaddr *)&conn->ksnc_peeraddr)) {
1496                         count++;
1497                         ksocknal_close_conn_locked(conn, why);
1498                 }
1499         }
1500
1501         return count;
1502 }
1503
1504 int
1505 ksocknal_close_conn_and_siblings(struct ksock_conn *conn, int why)
1506 {
1507         struct ksock_peer_ni *peer_ni = conn->ksnc_peer;
1508         int count;
1509
1510         write_lock_bh(&ksocknal_data.ksnd_global_lock);
1511
1512         count = ksocknal_close_peer_conns_locked(
1513                 peer_ni, (struct sockaddr *)&conn->ksnc_peeraddr, why);
1514
1515         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
1516
1517         return count;
1518 }
1519
1520 int
1521 ksocknal_close_matching_conns(struct lnet_process_id id, __u32 ipaddr)
1522 {
1523         struct ksock_peer_ni *peer_ni;
1524         struct hlist_node *pnxt;
1525         int lo;
1526         int hi;
1527         int i;
1528         int count = 0;
1529         struct sockaddr_in sa = {.sin_family = AF_INET};
1530
1531         write_lock_bh(&ksocknal_data.ksnd_global_lock);
1532
1533         if (id.nid != LNET_NID_ANY) {
1534                 lo = hash_min(id.nid, HASH_BITS(ksocknal_data.ksnd_peers));
1535                 hi = lo;
1536         } else {
1537                 lo = 0;
1538                 hi = HASH_SIZE(ksocknal_data.ksnd_peers) - 1;
1539         }
1540
1541         sa.sin_addr.s_addr = htonl(ipaddr);
1542         for (i = lo; i <= hi; i++) {
1543                 hlist_for_each_entry_safe(peer_ni, pnxt,
1544                                           &ksocknal_data.ksnd_peers[i],
1545                                           ksnp_list) {
1546
1547                         if (!((id.nid == LNET_NID_ANY ||
1548                                id.nid == peer_ni->ksnp_id.nid) &&
1549                               (id.pid == LNET_PID_ANY ||
1550                                id.pid == peer_ni->ksnp_id.pid)))
1551                                 continue;
1552
1553                         count += ksocknal_close_peer_conns_locked(
1554                                 peer_ni,
1555                                 ipaddr ? (struct sockaddr *)&sa : NULL, 0);
1556                 }
1557         }
1558
1559         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
1560
1561         /* wildcards always succeed */
1562         if (id.nid == LNET_NID_ANY || id.pid == LNET_PID_ANY || ipaddr == 0)
1563                 return 0;
1564
1565         return (count == 0 ? -ENOENT : 0);
1566 }
1567
1568 void
1569 ksocknal_notify_gw_down(lnet_nid_t gw_nid)
1570 {
1571         /* The router is telling me she's been notified of a change in
1572          * gateway state....
1573          */
1574         struct lnet_process_id id = {
1575                 .nid    = gw_nid,
1576                 .pid    = LNET_PID_ANY,
1577         };
1578
1579         CDEBUG(D_NET, "gw %s down\n", libcfs_nid2str(gw_nid));
1580
1581         /* If the gateway crashed, close all open connections... */
1582         ksocknal_close_matching_conns(id, 0);
1583         return;
1584
1585         /* We can only establish new connections
1586          * if we have autroutes, and these connect on demand. */
1587 }
1588
1589 static void
1590 ksocknal_push_peer(struct ksock_peer_ni *peer_ni)
1591 {
1592         int index;
1593         int i;
1594         struct list_head *tmp;
1595         struct ksock_conn *conn;
1596
1597         for (index = 0; ; index++) {
1598                 read_lock(&ksocknal_data.ksnd_global_lock);
1599
1600                 i = 0;
1601                 conn = NULL;
1602
1603                 list_for_each(tmp, &peer_ni->ksnp_conns) {
1604                         if (i++ == index) {
1605                                 conn = list_entry(tmp, struct ksock_conn,
1606                                                   ksnc_list);
1607                                 ksocknal_conn_addref(conn);
1608                                 break;
1609                         }
1610                 }
1611
1612                 read_unlock(&ksocknal_data.ksnd_global_lock);
1613
1614                 if (conn == NULL)
1615                         break;
1616
1617                 ksocknal_lib_push_conn (conn);
1618                 ksocknal_conn_decref(conn);
1619         }
1620 }
1621
1622 static int
1623 ksocknal_push(struct lnet_ni *ni, struct lnet_process_id id)
1624 {
1625         int lo;
1626         int hi;
1627         int bkt;
1628         int rc = -ENOENT;
1629
1630         if (id.nid != LNET_NID_ANY) {
1631                 lo = hash_min(id.nid, HASH_BITS(ksocknal_data.ksnd_peers));
1632                 hi = lo;
1633         } else {
1634                 lo = 0;
1635                 hi = HASH_SIZE(ksocknal_data.ksnd_peers) - 1;
1636         }
1637
1638         for (bkt = lo; bkt <= hi; bkt++) {
1639                 int peer_off; /* searching offset in peer_ni hash table */
1640
1641                 for (peer_off = 0; ; peer_off++) {
1642                         struct ksock_peer_ni *peer_ni;
1643                         int           i = 0;
1644
1645                         read_lock(&ksocknal_data.ksnd_global_lock);
1646                         hlist_for_each_entry(peer_ni,
1647                                              &ksocknal_data.ksnd_peers[bkt],
1648                                              ksnp_list) {
1649                                 if (!((id.nid == LNET_NID_ANY ||
1650                                        id.nid == peer_ni->ksnp_id.nid) &&
1651                                       (id.pid == LNET_PID_ANY ||
1652                                        id.pid == peer_ni->ksnp_id.pid)))
1653                                         continue;
1654
1655                                 if (i++ == peer_off) {
1656                                         ksocknal_peer_addref(peer_ni);
1657                                         break;
1658                                 }
1659                         }
1660                         read_unlock(&ksocknal_data.ksnd_global_lock);
1661
1662                         if (i <= peer_off) /* no match */
1663                                 break;
1664
1665                         rc = 0;
1666                         ksocknal_push_peer(peer_ni);
1667                         ksocknal_peer_decref(peer_ni);
1668                 }
1669         }
1670         return rc;
1671 }
1672
1673 int
1674 ksocknal_ctl(struct lnet_ni *ni, unsigned int cmd, void *arg)
1675 {
1676         struct lnet_process_id id = {0};
1677         struct libcfs_ioctl_data *data = arg;
1678         int rc;
1679
1680         switch(cmd) {
1681         case IOC_LIBCFS_GET_INTERFACE: {
1682                 struct ksock_net *net = ni->ni_data;
1683                 struct ksock_interface *iface;
1684                 struct sockaddr_in *sa;
1685
1686                 read_lock(&ksocknal_data.ksnd_global_lock);
1687
1688                 if (data->ioc_count >= 1) {
1689                         rc = -ENOENT;
1690                 } else {
1691                         rc = 0;
1692                         iface = &net->ksnn_interface;
1693
1694                         sa = (void *)&iface->ksni_addr;
1695                         if (sa->sin_family == AF_INET)
1696                                 data->ioc_u32[0] = ntohl(sa->sin_addr.s_addr);
1697                         else
1698                                 data->ioc_u32[0] = 0xFFFFFFFF;
1699                         data->ioc_u32[1] = iface->ksni_netmask;
1700                         data->ioc_u32[2] = iface->ksni_npeers;
1701                         data->ioc_u32[3] = iface->ksni_nroutes;
1702                 }
1703
1704                 read_unlock(&ksocknal_data.ksnd_global_lock);
1705                 return rc;
1706         }
1707
1708         case IOC_LIBCFS_GET_PEER: {
1709                 __u32            myip = 0;
1710                 __u32            ip = 0;
1711                 int              port = 0;
1712                 int              conn_count = 0;
1713                 int              share_count = 0;
1714
1715                 rc = ksocknal_get_peer_info(ni, data->ioc_count,
1716                                             &id, &myip, &ip, &port,
1717                                             &conn_count,  &share_count);
1718                 if (rc != 0)
1719                         return rc;
1720
1721                 data->ioc_nid    = id.nid;
1722                 data->ioc_count  = share_count;
1723                 data->ioc_u32[0] = ip;
1724                 data->ioc_u32[1] = port;
1725                 data->ioc_u32[2] = myip;
1726                 data->ioc_u32[3] = conn_count;
1727                 data->ioc_u32[4] = id.pid;
1728                 return 0;
1729         }
1730
1731         case IOC_LIBCFS_ADD_PEER: {
1732                 struct sockaddr_in sa = {.sin_family = AF_INET};
1733
1734                 id.nid = data->ioc_nid;
1735                 id.pid = LNET_PID_LUSTRE;
1736                 sa.sin_addr.s_addr = htonl(data->ioc_u32[0]);
1737                 sa.sin_port = htons(data->ioc_u32[1]);
1738                 return ksocknal_add_peer(ni, id, (struct sockaddr *)&sa);
1739         }
1740         case IOC_LIBCFS_DEL_PEER:
1741                 id.nid = data->ioc_nid;
1742                 id.pid = LNET_PID_ANY;
1743                 return ksocknal_del_peer (ni, id,
1744                                           data->ioc_u32[0]); /* IP */
1745
1746         case IOC_LIBCFS_GET_CONN: {
1747                 int           txmem;
1748                 int           rxmem;
1749                 int           nagle;
1750                 struct ksock_conn *conn = ksocknal_get_conn_by_idx(ni, data->ioc_count);
1751                 struct sockaddr_in *psa = (void *)&conn->ksnc_peeraddr;
1752                 struct sockaddr_in *mysa = (void *)&conn->ksnc_myaddr;
1753
1754                 if (conn == NULL)
1755                         return -ENOENT;
1756
1757                 ksocknal_lib_get_conn_tunables(conn, &txmem, &rxmem, &nagle);
1758
1759                 data->ioc_count  = txmem;
1760                 data->ioc_nid    = conn->ksnc_peer->ksnp_id.nid;
1761                 data->ioc_flags  = nagle;
1762                 if (psa->sin_family == AF_INET)
1763                         data->ioc_u32[0] = ntohl(psa->sin_addr.s_addr);
1764                 else
1765                         data->ioc_u32[0] = 0xFFFFFFFF;
1766                 data->ioc_u32[1] = rpc_get_port((struct sockaddr *)
1767                                                 &conn->ksnc_peeraddr);
1768                 if (mysa->sin_family == AF_INET)
1769                         data->ioc_u32[2] = ntohl(mysa->sin_addr.s_addr);
1770                 else
1771                         data->ioc_u32[2] = 0xFFFFFFFF;
1772                 data->ioc_u32[3] = conn->ksnc_type;
1773                 data->ioc_u32[4] = conn->ksnc_scheduler->kss_cpt;
1774                 data->ioc_u32[5] = rxmem;
1775                 data->ioc_u32[6] = conn->ksnc_peer->ksnp_id.pid;
1776                 ksocknal_conn_decref(conn);
1777                 return 0;
1778         }
1779
1780         case IOC_LIBCFS_CLOSE_CONNECTION:
1781                 id.nid = data->ioc_nid;
1782                 id.pid = LNET_PID_ANY;
1783                 return ksocknal_close_matching_conns (id,
1784                                                       data->ioc_u32[0]);
1785
1786         case IOC_LIBCFS_REGISTER_MYNID:
1787                 /* Ignore if this is a noop */
1788                 if (data->ioc_nid == ni->ni_nid)
1789                         return 0;
1790
1791                 CERROR("obsolete IOC_LIBCFS_REGISTER_MYNID: %s(%s)\n",
1792                        libcfs_nid2str(data->ioc_nid),
1793                        libcfs_nid2str(ni->ni_nid));
1794                 return -EINVAL;
1795
1796         case IOC_LIBCFS_PUSH_CONNECTION:
1797                 id.nid = data->ioc_nid;
1798                 id.pid = LNET_PID_ANY;
1799                 return ksocknal_push(ni, id);
1800
1801         default:
1802                 return -EINVAL;
1803         }
1804         /* not reached */
1805 }
1806
1807 static void
1808 ksocknal_free_buffers (void)
1809 {
1810         LASSERT (atomic_read(&ksocknal_data.ksnd_nactive_txs) == 0);
1811
1812         if (ksocknal_data.ksnd_schedulers != NULL)
1813                 cfs_percpt_free(ksocknal_data.ksnd_schedulers);
1814
1815         spin_lock(&ksocknal_data.ksnd_tx_lock);
1816
1817         if (!list_empty(&ksocknal_data.ksnd_idle_noop_txs)) {
1818                 LIST_HEAD(zlist);
1819                 struct ksock_tx *tx;
1820
1821                 list_splice_init(&ksocknal_data.ksnd_idle_noop_txs, &zlist);
1822                 spin_unlock(&ksocknal_data.ksnd_tx_lock);
1823
1824                 while ((tx = list_first_entry_or_null(&zlist, struct ksock_tx,
1825                                                       tx_list)) != NULL) {
1826                         list_del(&tx->tx_list);
1827                         LIBCFS_FREE(tx, tx->tx_desc_size);
1828                 }
1829         } else {
1830                 spin_unlock(&ksocknal_data.ksnd_tx_lock);
1831         }
1832 }
1833
1834 static void
1835 ksocknal_base_shutdown(void)
1836 {
1837         struct ksock_sched *sched;
1838         struct ksock_peer_ni *peer_ni;
1839         int i;
1840
1841         CDEBUG(D_MALLOC, "before NAL cleanup: kmem %lld\n",
1842                libcfs_kmem_read());
1843         LASSERT (ksocknal_data.ksnd_nnets == 0);
1844
1845         switch (ksocknal_data.ksnd_init) {
1846         default:
1847                 LASSERT(0);
1848                 /* fallthrough */
1849
1850         case SOCKNAL_INIT_ALL:
1851         case SOCKNAL_INIT_DATA:
1852                 hash_for_each(ksocknal_data.ksnd_peers, i, peer_ni, ksnp_list)
1853                         LASSERT(0);
1854
1855                 LASSERT(list_empty(&ksocknal_data.ksnd_nets));
1856                 LASSERT(list_empty(&ksocknal_data.ksnd_enomem_conns));
1857                 LASSERT(list_empty(&ksocknal_data.ksnd_zombie_conns));
1858                 LASSERT(list_empty(&ksocknal_data.ksnd_connd_connreqs));
1859                 LASSERT(list_empty(&ksocknal_data.ksnd_connd_routes));
1860
1861                 if (ksocknal_data.ksnd_schedulers != NULL) {
1862                         cfs_percpt_for_each(sched, i,
1863                                             ksocknal_data.ksnd_schedulers) {
1864
1865                                 LASSERT(list_empty(&sched->kss_tx_conns));
1866                                 LASSERT(list_empty(&sched->kss_rx_conns));
1867                                 LASSERT(list_empty(&sched->kss_zombie_noop_txs));
1868                                 LASSERT(sched->kss_nconns == 0);
1869                         }
1870                 }
1871
1872                 /* flag threads to terminate; wake and wait for them to die */
1873                 ksocknal_data.ksnd_shuttingdown = 1;
1874                 wake_up_all(&ksocknal_data.ksnd_connd_waitq);
1875                 wake_up(&ksocknal_data.ksnd_reaper_waitq);
1876
1877                 if (ksocknal_data.ksnd_schedulers != NULL) {
1878                         cfs_percpt_for_each(sched, i,
1879                                             ksocknal_data.ksnd_schedulers)
1880                                         wake_up_all(&sched->kss_waitq);
1881                 }
1882
1883                 wait_var_event_warning(&ksocknal_data.ksnd_nthreads,
1884                                        atomic_read(&ksocknal_data.ksnd_nthreads) == 0,
1885                                        "waiting for %d threads to terminate\n",
1886                                        atomic_read(&ksocknal_data.ksnd_nthreads));
1887
1888                 ksocknal_free_buffers();
1889
1890                 ksocknal_data.ksnd_init = SOCKNAL_INIT_NOTHING;
1891                 break;
1892         }
1893
1894         CDEBUG(D_MALLOC, "after NAL cleanup: kmem %lld\n",
1895                libcfs_kmem_read());
1896
1897         module_put(THIS_MODULE);
1898 }
1899
1900 static int
1901 ksocknal_base_startup(void)
1902 {
1903         struct ksock_sched *sched;
1904         int rc;
1905         int i;
1906
1907         LASSERT(ksocknal_data.ksnd_init == SOCKNAL_INIT_NOTHING);
1908         LASSERT(ksocknal_data.ksnd_nnets == 0);
1909
1910         memset(&ksocknal_data, 0, sizeof(ksocknal_data)); /* zero pointers */
1911
1912         hash_init(ksocknal_data.ksnd_peers);
1913
1914         rwlock_init(&ksocknal_data.ksnd_global_lock);
1915         INIT_LIST_HEAD(&ksocknal_data.ksnd_nets);
1916
1917         spin_lock_init(&ksocknal_data.ksnd_reaper_lock);
1918         INIT_LIST_HEAD(&ksocknal_data.ksnd_enomem_conns);
1919         INIT_LIST_HEAD(&ksocknal_data.ksnd_zombie_conns);
1920         INIT_LIST_HEAD(&ksocknal_data.ksnd_deathrow_conns);
1921         init_waitqueue_head(&ksocknal_data.ksnd_reaper_waitq);
1922
1923         spin_lock_init(&ksocknal_data.ksnd_connd_lock);
1924         INIT_LIST_HEAD(&ksocknal_data.ksnd_connd_connreqs);
1925         INIT_LIST_HEAD(&ksocknal_data.ksnd_connd_routes);
1926         init_waitqueue_head(&ksocknal_data.ksnd_connd_waitq);
1927
1928         spin_lock_init(&ksocknal_data.ksnd_tx_lock);
1929         INIT_LIST_HEAD(&ksocknal_data.ksnd_idle_noop_txs);
1930
1931         /* NB memset above zeros whole of ksocknal_data */
1932
1933         /* flag lists/ptrs/locks initialised */
1934         ksocknal_data.ksnd_init = SOCKNAL_INIT_DATA;
1935         if (!try_module_get(THIS_MODULE))
1936                 goto failed;
1937
1938         /* Create a scheduler block per available CPT */
1939         ksocknal_data.ksnd_schedulers = cfs_percpt_alloc(lnet_cpt_table(),
1940                                                          sizeof(*sched));
1941         if (ksocknal_data.ksnd_schedulers == NULL)
1942                 goto failed;
1943
1944         cfs_percpt_for_each(sched, i, ksocknal_data.ksnd_schedulers) {
1945                 int nthrs;
1946
1947                 /*
1948                  * make sure not to allocate more threads than there are
1949                  * cores/CPUs in teh CPT
1950                  */
1951                 nthrs = cfs_cpt_weight(lnet_cpt_table(), i);
1952                 if (*ksocknal_tunables.ksnd_nscheds > 0) {
1953                         nthrs = min(nthrs, *ksocknal_tunables.ksnd_nscheds);
1954                 } else {
1955                         /*
1956                          * max to half of CPUs, assume another half should be
1957                          * reserved for upper layer modules
1958                          */
1959                         nthrs = min(max(SOCKNAL_NSCHEDS, nthrs >> 1), nthrs);
1960                 }
1961
1962                 sched->kss_nthreads_max = nthrs;
1963                 sched->kss_cpt = i;
1964
1965                 spin_lock_init(&sched->kss_lock);
1966                 INIT_LIST_HEAD(&sched->kss_rx_conns);
1967                 INIT_LIST_HEAD(&sched->kss_tx_conns);
1968                 INIT_LIST_HEAD(&sched->kss_zombie_noop_txs);
1969                 init_waitqueue_head(&sched->kss_waitq);
1970         }
1971
1972         ksocknal_data.ksnd_connd_starting         = 0;
1973         ksocknal_data.ksnd_connd_failed_stamp     = 0;
1974         ksocknal_data.ksnd_connd_starting_stamp   = ktime_get_real_seconds();
1975         /* must have at least 2 connds to remain responsive to accepts while
1976          * connecting */
1977         if (*ksocknal_tunables.ksnd_nconnds < SOCKNAL_CONND_RESV + 1)
1978                 *ksocknal_tunables.ksnd_nconnds = SOCKNAL_CONND_RESV + 1;
1979
1980         if (*ksocknal_tunables.ksnd_nconnds_max <
1981             *ksocknal_tunables.ksnd_nconnds) {
1982                 ksocknal_tunables.ksnd_nconnds_max =
1983                         ksocknal_tunables.ksnd_nconnds;
1984         }
1985
1986         for (i = 0; i < *ksocknal_tunables.ksnd_nconnds; i++) {
1987                 char name[16];
1988                 spin_lock_bh(&ksocknal_data.ksnd_connd_lock);
1989                 ksocknal_data.ksnd_connd_starting++;
1990                 spin_unlock_bh(&ksocknal_data.ksnd_connd_lock);
1991
1992
1993                 snprintf(name, sizeof(name), "socknal_cd%02d", i);
1994                 rc = ksocknal_thread_start(ksocknal_connd,
1995                                            (void *)((uintptr_t)i), name);
1996                 if (rc != 0) {
1997                         spin_lock_bh(&ksocknal_data.ksnd_connd_lock);
1998                         ksocknal_data.ksnd_connd_starting--;
1999                         spin_unlock_bh(&ksocknal_data.ksnd_connd_lock);
2000                         CERROR("Can't spawn socknal connd: %d\n", rc);
2001                         goto failed;
2002                 }
2003         }
2004
2005         rc = ksocknal_thread_start(ksocknal_reaper, NULL, "socknal_reaper");
2006         if (rc != 0) {
2007                 CERROR ("Can't spawn socknal reaper: %d\n", rc);
2008                 goto failed;
2009         }
2010
2011         /* flag everything initialised */
2012         ksocknal_data.ksnd_init = SOCKNAL_INIT_ALL;
2013
2014         return 0;
2015
2016  failed:
2017         ksocknal_base_shutdown();
2018         return -ENETDOWN;
2019 }
2020
2021 static int
2022 ksocknal_debug_peerhash(struct lnet_ni *ni)
2023 {
2024         struct ksock_peer_ni *peer_ni;
2025         int i;
2026
2027         read_lock(&ksocknal_data.ksnd_global_lock);
2028
2029         hash_for_each(ksocknal_data.ksnd_peers, i, peer_ni, ksnp_list) {
2030                 struct ksock_conn_cb *conn_cb;
2031                 struct ksock_conn *conn;
2032
2033                 if (peer_ni->ksnp_ni != ni)
2034                         continue;
2035
2036                 CWARN("Active peer_ni on shutdown: %s, ref %d, "
2037                       "closing %d, accepting %d, err %d, zcookie %llu, "
2038                       "txq %d, zc_req %d\n", libcfs_id2str(peer_ni->ksnp_id),
2039                       refcount_read(&peer_ni->ksnp_refcount),
2040                       peer_ni->ksnp_closing,
2041                       peer_ni->ksnp_accepting, peer_ni->ksnp_error,
2042                       peer_ni->ksnp_zc_next_cookie,
2043                       !list_empty(&peer_ni->ksnp_tx_queue),
2044                       !list_empty(&peer_ni->ksnp_zc_req_list));
2045
2046                 conn_cb = peer_ni->ksnp_conn_cb;
2047                 if (conn_cb) {
2048                         CWARN("ConnCB: ref %d, schd %d, conn %d, cnted %d, del %d\n",
2049                               refcount_read(&conn_cb->ksnr_refcount),
2050                               conn_cb->ksnr_scheduled, conn_cb->ksnr_connecting,
2051                               conn_cb->ksnr_connected, conn_cb->ksnr_deleted);
2052                 }
2053
2054                 list_for_each_entry(conn, &peer_ni->ksnp_conns, ksnc_list) {
2055                         CWARN("Conn: ref %d, sref %d, t %d, c %d\n",
2056                               refcount_read(&conn->ksnc_conn_refcount),
2057                               refcount_read(&conn->ksnc_sock_refcount),
2058                               conn->ksnc_type, conn->ksnc_closing);
2059                 }
2060                 break;
2061         }
2062
2063         read_unlock(&ksocknal_data.ksnd_global_lock);
2064         return 0;
2065 }
2066
2067 void
2068 ksocknal_shutdown(struct lnet_ni *ni)
2069 {
2070         struct ksock_net *net = ni->ni_data;
2071         struct lnet_process_id anyid = {
2072                 .nid = LNET_NID_ANY,
2073                 .pid = LNET_PID_ANY,
2074         };
2075
2076         LASSERT(ksocknal_data.ksnd_init == SOCKNAL_INIT_ALL);
2077         LASSERT(ksocknal_data.ksnd_nnets > 0);
2078
2079         /* prevent new peers */
2080         atomic_add(SOCKNAL_SHUTDOWN_BIAS, &net->ksnn_npeers);
2081
2082         /* Delete all peers */
2083         ksocknal_del_peer(ni, anyid, 0);
2084
2085         /* Wait for all peer_ni state to clean up */
2086         wait_var_event_warning(&net->ksnn_npeers,
2087                                atomic_read(&net->ksnn_npeers) ==
2088                                SOCKNAL_SHUTDOWN_BIAS,
2089                                "waiting for %d peers to disconnect\n",
2090                                ksocknal_debug_peerhash(ni) +
2091                                atomic_read(&net->ksnn_npeers) -
2092                                SOCKNAL_SHUTDOWN_BIAS);
2093
2094         LASSERT(net->ksnn_interface.ksni_npeers == 0);
2095         LASSERT(net->ksnn_interface.ksni_nroutes == 0);
2096
2097         list_del(&net->ksnn_list);
2098         LIBCFS_FREE(net, sizeof(*net));
2099
2100         ksocknal_data.ksnd_nnets--;
2101         if (ksocknal_data.ksnd_nnets == 0)
2102                 ksocknal_base_shutdown();
2103 }
2104
2105 static int
2106 ksocknal_search_new_ipif(struct ksock_net *net)
2107 {
2108         int new_ipif = 0;
2109         char *ifnam = &net->ksnn_interface.ksni_name[0];
2110         char *colon = strchr(ifnam, ':');
2111         bool found = false;
2112         struct ksock_net *tmp;
2113
2114         if (colon != NULL)
2115                 *colon = 0;
2116
2117         list_for_each_entry(tmp, &ksocknal_data.ksnd_nets, ksnn_list) {
2118                 char *ifnam2 = &tmp->ksnn_interface.ksni_name[0];
2119                 char *colon2 = strchr(ifnam2, ':');
2120
2121                 if (colon2 != NULL)
2122                         *colon2 = 0;
2123
2124                 found = strcmp(ifnam, ifnam2) == 0;
2125                 if (colon2 != NULL)
2126                         *colon2 = ':';
2127         }
2128
2129         new_ipif += !found;
2130         if (colon != NULL)
2131                 *colon = ':';
2132
2133         return new_ipif;
2134 }
2135
2136 static int
2137 ksocknal_start_schedulers(struct ksock_sched *sched)
2138 {
2139         int     nthrs;
2140         int     rc = 0;
2141         int     i;
2142
2143         if (sched->kss_nthreads == 0) {
2144                 if (*ksocknal_tunables.ksnd_nscheds > 0) {
2145                         nthrs = sched->kss_nthreads_max;
2146                 } else {
2147                         nthrs = cfs_cpt_weight(lnet_cpt_table(),
2148                                                sched->kss_cpt);
2149                         nthrs = min(max(SOCKNAL_NSCHEDS, nthrs >> 1), nthrs);
2150                         nthrs = min(SOCKNAL_NSCHEDS_HIGH, nthrs);
2151                 }
2152                 nthrs = min(nthrs, sched->kss_nthreads_max);
2153         } else {
2154                 LASSERT(sched->kss_nthreads <= sched->kss_nthreads_max);
2155                 /* increase two threads if there is new interface */
2156                 nthrs = min(2, sched->kss_nthreads_max - sched->kss_nthreads);
2157         }
2158
2159         for (i = 0; i < nthrs; i++) {
2160                 long id;
2161                 char name[20];
2162
2163                 id = KSOCK_THREAD_ID(sched->kss_cpt, sched->kss_nthreads + i);
2164                 snprintf(name, sizeof(name), "socknal_sd%02d_%02d",
2165                          sched->kss_cpt, (int)KSOCK_THREAD_SID(id));
2166
2167                 rc = ksocknal_thread_start(ksocknal_scheduler,
2168                                            (void *)id, name);
2169                 if (rc == 0)
2170                         continue;
2171
2172                 CERROR("Can't spawn thread %d for scheduler[%d]: %d\n",
2173                        sched->kss_cpt, (int) KSOCK_THREAD_SID(id), rc);
2174                 break;
2175         }
2176
2177         sched->kss_nthreads += i;
2178         return rc;
2179 }
2180
2181 static int
2182 ksocknal_net_start_threads(struct ksock_net *net, __u32 *cpts, int ncpts)
2183 {
2184         int newif = ksocknal_search_new_ipif(net);
2185         int rc;
2186         int i;
2187
2188         if (ncpts > 0 && ncpts > cfs_cpt_number(lnet_cpt_table()))
2189                 return -EINVAL;
2190
2191         for (i = 0; i < ncpts; i++) {
2192                 struct ksock_sched *sched;
2193                 int cpt = (cpts == NULL) ? i : cpts[i];
2194
2195                 LASSERT(cpt < cfs_cpt_number(lnet_cpt_table()));
2196                 sched = ksocknal_data.ksnd_schedulers[cpt];
2197
2198                 if (!newif && sched->kss_nthreads > 0)
2199                         continue;
2200
2201                 rc = ksocknal_start_schedulers(sched);
2202                 if (rc != 0)
2203                         return rc;
2204         }
2205         return 0;
2206 }
2207
2208 int
2209 ksocknal_startup(struct lnet_ni *ni)
2210 {
2211         struct ksock_net *net;
2212         struct lnet_ioctl_config_lnd_cmn_tunables *net_tunables;
2213         struct ksock_interface *ksi = NULL;
2214         struct lnet_inetdev *ifaces = NULL;
2215         struct sockaddr_in *sa;
2216         int i = 0;
2217         int rc;
2218
2219         LASSERT (ni->ni_net->net_lnd == &the_ksocklnd);
2220         if (ksocknal_data.ksnd_init == SOCKNAL_INIT_NOTHING) {
2221                 rc = ksocknal_base_startup();
2222                 if (rc != 0)
2223                         return rc;
2224         }
2225         LIBCFS_ALLOC(net, sizeof(*net));
2226         if (net == NULL)
2227                 goto fail_0;
2228         net->ksnn_incarnation = ktime_get_real_ns();
2229         ni->ni_data = net;
2230         net_tunables = &ni->ni_net->net_tunables;
2231         if (net_tunables->lct_peer_timeout == -1)
2232                 net_tunables->lct_peer_timeout =
2233                         *ksocknal_tunables.ksnd_peertimeout;
2234
2235         if (net_tunables->lct_max_tx_credits == -1)
2236                 net_tunables->lct_max_tx_credits =
2237                         *ksocknal_tunables.ksnd_credits;
2238
2239         if (net_tunables->lct_peer_tx_credits == -1)
2240                 net_tunables->lct_peer_tx_credits =
2241                         *ksocknal_tunables.ksnd_peertxcredits;
2242
2243         if (net_tunables->lct_peer_tx_credits >
2244             net_tunables->lct_max_tx_credits)
2245                 net_tunables->lct_peer_tx_credits =
2246                         net_tunables->lct_max_tx_credits;
2247
2248         if (net_tunables->lct_peer_rtr_credits == -1)
2249                 net_tunables->lct_peer_rtr_credits =
2250                         *ksocknal_tunables.ksnd_peerrtrcredits;
2251
2252         rc = lnet_inet_enumerate(&ifaces, ni->ni_net_ns);
2253         if (rc < 0)
2254                 goto fail_1;
2255
2256         ksi = &net->ksnn_interface;
2257
2258         /* Use the first discovered interface or look in the list */
2259         if (ni->ni_interface) {
2260                 for (i = 0; i < rc; i++)
2261                         if (strcmp(ifaces[i].li_name, ni->ni_interface) == 0)
2262                                 break;
2263
2264                 /* ni_interfaces doesn't contain the interface we want */
2265                 if (i == rc) {
2266                         CERROR("ksocklnd: failed to find interface %s\n",
2267                                ni->ni_interface);
2268                         goto fail_1;
2269                 }
2270         }
2271
2272         ni->ni_dev_cpt = ifaces[i].li_cpt;
2273         sa = (void *)&ksi->ksni_addr;
2274         memset(sa, 0, sizeof(*sa));
2275         sa->sin_family = AF_INET;
2276         sa->sin_addr.s_addr = htonl(ifaces[i].li_ipaddr);
2277         ksi->ksni_index = ksocknal_ip2index((struct sockaddr *)sa, ni);
2278         ksi->ksni_netmask = ifaces[i].li_netmask;
2279         strlcpy(ksi->ksni_name, ifaces[i].li_name, sizeof(ksi->ksni_name));
2280
2281         /* call it before add it to ksocknal_data.ksnd_nets */
2282         rc = ksocknal_net_start_threads(net, ni->ni_cpts, ni->ni_ncpts);
2283         if (rc != 0)
2284                 goto fail_1;
2285
2286         LASSERT(ksi);
2287         LASSERT(ksi->ksni_addr.ss_family == AF_INET);
2288         ni->ni_nid = LNET_MKNID(
2289                 LNET_NIDNET(ni->ni_nid),
2290                 ntohl(((struct sockaddr_in *)
2291                        &ksi->ksni_addr)->sin_addr.s_addr));
2292         list_add(&net->ksnn_list, &ksocknal_data.ksnd_nets);
2293         ksocknal_data.ksnd_nnets++;
2294
2295         return 0;
2296
2297 fail_1:
2298         LIBCFS_FREE(net, sizeof(*net));
2299 fail_0:
2300         if (ksocknal_data.ksnd_nnets == 0)
2301                 ksocknal_base_shutdown();
2302
2303         return -ENETDOWN;
2304 }
2305
2306
2307 static void __exit ksocklnd_exit(void)
2308 {
2309         lnet_unregister_lnd(&the_ksocklnd);
2310 }
2311
2312 static const struct lnet_lnd the_ksocklnd = {
2313         .lnd_type               = SOCKLND,
2314         .lnd_startup            = ksocknal_startup,
2315         .lnd_shutdown           = ksocknal_shutdown,
2316         .lnd_ctl                = ksocknal_ctl,
2317         .lnd_send               = ksocknal_send,
2318         .lnd_recv               = ksocknal_recv,
2319         .lnd_notify_peer_down   = ksocknal_notify_gw_down,
2320         .lnd_accept             = ksocknal_accept,
2321 };
2322
2323 static int __init ksocklnd_init(void)
2324 {
2325         int rc;
2326
2327         /* check ksnr_connected/connecting field large enough */
2328         BUILD_BUG_ON(SOCKLND_CONN_NTYPES > 4);
2329         BUILD_BUG_ON(SOCKLND_CONN_ACK != SOCKLND_CONN_BULK_IN);
2330
2331         rc = ksocknal_tunables_init();
2332         if (rc != 0)
2333                 return rc;
2334
2335         lnet_register_lnd(&the_ksocklnd);
2336
2337         return 0;
2338 }
2339
2340 MODULE_AUTHOR("OpenSFS, Inc. <http://www.lustre.org/>");
2341 MODULE_DESCRIPTION("TCP Socket LNet Network Driver");
2342 MODULE_VERSION("2.8.0");
2343 MODULE_LICENSE("GPL");
2344
2345 module_init(ksocklnd_init);
2346 module_exit(ksocklnd_exit);