Whamcloud - gitweb
LU-12815 socklnd: add conns_per_peer parameter
[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 (!list_empty(&zlist)) {
1340                 tx = list_entry(zlist.next, struct ksock_tx, tx_zc_list);
1341
1342                 list_del(&tx->tx_zc_list);
1343                 ksocknal_tx_decref(tx);
1344         }
1345 }
1346
1347 void
1348 ksocknal_terminate_conn(struct ksock_conn *conn)
1349 {
1350         /* This gets called by the reaper (guaranteed thread context) to
1351          * disengage the socket from its callbacks and close it.
1352          * ksnc_refcount will eventually hit zero, and then the reaper will
1353          * destroy it.
1354          */
1355         struct ksock_peer_ni *peer_ni = conn->ksnc_peer;
1356         struct ksock_sched *sched = conn->ksnc_scheduler;
1357         bool failed = false;
1358
1359         LASSERT(conn->ksnc_closing);
1360
1361         /* wake up the scheduler to "send" all remaining packets to /dev/null */
1362         spin_lock_bh(&sched->kss_lock);
1363
1364         /* a closing conn is always ready to tx */
1365         conn->ksnc_tx_ready = 1;
1366
1367         if (!conn->ksnc_tx_scheduled &&
1368             !list_empty(&conn->ksnc_tx_queue)) {
1369                 list_add_tail(&conn->ksnc_tx_list,
1370                               &sched->kss_tx_conns);
1371                 conn->ksnc_tx_scheduled = 1;
1372                 /* extra ref for scheduler */
1373                 ksocknal_conn_addref(conn);
1374
1375                 wake_up(&sched->kss_waitq);
1376         }
1377
1378         spin_unlock_bh(&sched->kss_lock);
1379
1380         /* serialise with callbacks */
1381         write_lock_bh(&ksocknal_data.ksnd_global_lock);
1382
1383         ksocknal_lib_reset_callback(conn->ksnc_sock, conn);
1384
1385         /* OK, so this conn may not be completely disengaged from its
1386          * scheduler yet, but it _has_ committed to terminate...
1387          */
1388         conn->ksnc_scheduler->kss_nconns--;
1389
1390         if (peer_ni->ksnp_error != 0) {
1391                 /* peer_ni's last conn closed in error */
1392                 LASSERT(list_empty(&peer_ni->ksnp_conns));
1393                 failed = true;
1394                 peer_ni->ksnp_error = 0;     /* avoid multiple notifications */
1395         }
1396
1397         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
1398
1399         if (failed)
1400                 ksocknal_peer_failed(peer_ni);
1401
1402         /* The socket is closed on the final put; either here, or in
1403          * ksocknal_{send,recv}msg().  Since we set up the linger2 option
1404          * when the connection was established, this will close the socket
1405          * immediately, aborting anything buffered in it. Any hung
1406          * zero-copy transmits will therefore complete in finite time.
1407          */
1408         ksocknal_connsock_decref(conn);
1409 }
1410
1411 void
1412 ksocknal_queue_zombie_conn(struct ksock_conn *conn)
1413 {
1414         /* Queue the conn for the reaper to destroy */
1415         LASSERT(refcount_read(&conn->ksnc_conn_refcount) == 0);
1416         spin_lock_bh(&ksocknal_data.ksnd_reaper_lock);
1417
1418         list_add_tail(&conn->ksnc_list, &ksocknal_data.ksnd_zombie_conns);
1419         wake_up(&ksocknal_data.ksnd_reaper_waitq);
1420
1421         spin_unlock_bh(&ksocknal_data.ksnd_reaper_lock);
1422 }
1423
1424 void
1425 ksocknal_destroy_conn(struct ksock_conn *conn)
1426 {
1427         time64_t last_rcv;
1428
1429         /* Final coup-de-grace of the reaper */
1430         CDEBUG(D_NET, "connection %p\n", conn);
1431
1432         LASSERT(refcount_read(&conn->ksnc_conn_refcount) == 0);
1433         LASSERT(refcount_read(&conn->ksnc_sock_refcount) == 0);
1434         LASSERT(conn->ksnc_sock == NULL);
1435         LASSERT(conn->ksnc_conn_cb == NULL);
1436         LASSERT(!conn->ksnc_tx_scheduled);
1437         LASSERT(!conn->ksnc_rx_scheduled);
1438         LASSERT(list_empty(&conn->ksnc_tx_queue));
1439
1440         /* complete current receive if any */
1441         switch (conn->ksnc_rx_state) {
1442         case SOCKNAL_RX_LNET_PAYLOAD:
1443                 last_rcv = conn->ksnc_rx_deadline -
1444                            ksocknal_timeout();
1445                 CERROR("Completing partial receive from %s[%d], ip %pISp, with error, wanted: %d, left: %d, last alive is %lld secs ago\n",
1446                        libcfs_id2str(conn->ksnc_peer->ksnp_id), conn->ksnc_type,
1447                        &conn->ksnc_peeraddr,
1448                        conn->ksnc_rx_nob_wanted, conn->ksnc_rx_nob_left,
1449                        ktime_get_seconds() - last_rcv);
1450                 if (conn->ksnc_lnet_msg)
1451                         conn->ksnc_lnet_msg->msg_health_status =
1452                                 LNET_MSG_STATUS_REMOTE_ERROR;
1453                 lnet_finalize(conn->ksnc_lnet_msg, -EIO);
1454                 break;
1455         case SOCKNAL_RX_LNET_HEADER:
1456                 if (conn->ksnc_rx_started)
1457                         CERROR("Incomplete receive of lnet header from %s, ip %pISp, with error, protocol: %d.x.\n",
1458                                libcfs_id2str(conn->ksnc_peer->ksnp_id),
1459                                &conn->ksnc_peeraddr,
1460                                conn->ksnc_proto->pro_version);
1461                 break;
1462         case SOCKNAL_RX_KSM_HEADER:
1463                 if (conn->ksnc_rx_started)
1464                         CERROR("Incomplete receive of ksock message from %s, ip %pISp, with error, protocol: %d.x.\n",
1465                                libcfs_id2str(conn->ksnc_peer->ksnp_id),
1466                                &conn->ksnc_peeraddr,
1467                                conn->ksnc_proto->pro_version);
1468                 break;
1469         case SOCKNAL_RX_SLOP:
1470                 if (conn->ksnc_rx_started)
1471                         CERROR("Incomplete receive of slops from %s, ip %pISp, with error\n",
1472                                libcfs_id2str(conn->ksnc_peer->ksnp_id),
1473                                &conn->ksnc_peeraddr);
1474                break;
1475         default:
1476                 LBUG ();
1477                 break;
1478         }
1479
1480         ksocknal_peer_decref(conn->ksnc_peer);
1481
1482         LIBCFS_FREE (conn, sizeof (*conn));
1483 }
1484
1485 int
1486 ksocknal_close_peer_conns_locked(struct ksock_peer_ni *peer_ni,
1487                                  struct sockaddr *addr, int why)
1488 {
1489         struct ksock_conn *conn;
1490         struct ksock_conn *cnxt;
1491         int count = 0;
1492
1493         list_for_each_entry_safe(conn, cnxt, &peer_ni->ksnp_conns, ksnc_list) {
1494                 if (!addr ||
1495                     rpc_cmp_addr(addr,
1496                                  (struct sockaddr *)&conn->ksnc_peeraddr)) {
1497                         count++;
1498                         ksocknal_close_conn_locked(conn, why);
1499                 }
1500         }
1501
1502         return count;
1503 }
1504
1505 int
1506 ksocknal_close_conn_and_siblings(struct ksock_conn *conn, int why)
1507 {
1508         struct ksock_peer_ni *peer_ni = conn->ksnc_peer;
1509         int count;
1510
1511         write_lock_bh(&ksocknal_data.ksnd_global_lock);
1512
1513         count = ksocknal_close_peer_conns_locked(
1514                 peer_ni, (struct sockaddr *)&conn->ksnc_peeraddr, why);
1515
1516         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
1517
1518         return count;
1519 }
1520
1521 int
1522 ksocknal_close_matching_conns(struct lnet_process_id id, __u32 ipaddr)
1523 {
1524         struct ksock_peer_ni *peer_ni;
1525         struct hlist_node *pnxt;
1526         int lo;
1527         int hi;
1528         int i;
1529         int count = 0;
1530         struct sockaddr_in sa = {.sin_family = AF_INET};
1531
1532         write_lock_bh(&ksocknal_data.ksnd_global_lock);
1533
1534         if (id.nid != LNET_NID_ANY) {
1535                 lo = hash_min(id.nid, HASH_BITS(ksocknal_data.ksnd_peers));
1536                 hi = lo;
1537         } else {
1538                 lo = 0;
1539                 hi = HASH_SIZE(ksocknal_data.ksnd_peers) - 1;
1540         }
1541
1542         sa.sin_addr.s_addr = htonl(ipaddr);
1543         for (i = lo; i <= hi; i++) {
1544                 hlist_for_each_entry_safe(peer_ni, pnxt,
1545                                           &ksocknal_data.ksnd_peers[i],
1546                                           ksnp_list) {
1547
1548                         if (!((id.nid == LNET_NID_ANY ||
1549                                id.nid == peer_ni->ksnp_id.nid) &&
1550                               (id.pid == LNET_PID_ANY ||
1551                                id.pid == peer_ni->ksnp_id.pid)))
1552                                 continue;
1553
1554                         count += ksocknal_close_peer_conns_locked(
1555                                 peer_ni,
1556                                 ipaddr ? (struct sockaddr *)&sa : NULL, 0);
1557                 }
1558         }
1559
1560         write_unlock_bh(&ksocknal_data.ksnd_global_lock);
1561
1562         /* wildcards always succeed */
1563         if (id.nid == LNET_NID_ANY || id.pid == LNET_PID_ANY || ipaddr == 0)
1564                 return 0;
1565
1566         return (count == 0 ? -ENOENT : 0);
1567 }
1568
1569 void
1570 ksocknal_notify_gw_down(lnet_nid_t gw_nid)
1571 {
1572         /* The router is telling me she's been notified of a change in
1573          * gateway state....
1574          */
1575         struct lnet_process_id id = {
1576                 .nid    = gw_nid,
1577                 .pid    = LNET_PID_ANY,
1578         };
1579
1580         CDEBUG(D_NET, "gw %s down\n", libcfs_nid2str(gw_nid));
1581
1582         /* If the gateway crashed, close all open connections... */
1583         ksocknal_close_matching_conns(id, 0);
1584         return;
1585
1586         /* We can only establish new connections
1587          * if we have autroutes, and these connect on demand. */
1588 }
1589
1590 static void
1591 ksocknal_push_peer(struct ksock_peer_ni *peer_ni)
1592 {
1593         int index;
1594         int i;
1595         struct list_head *tmp;
1596         struct ksock_conn *conn;
1597
1598         for (index = 0; ; index++) {
1599                 read_lock(&ksocknal_data.ksnd_global_lock);
1600
1601                 i = 0;
1602                 conn = NULL;
1603
1604                 list_for_each(tmp, &peer_ni->ksnp_conns) {
1605                         if (i++ == index) {
1606                                 conn = list_entry(tmp, struct ksock_conn,
1607                                                   ksnc_list);
1608                                 ksocknal_conn_addref(conn);
1609                                 break;
1610                         }
1611                 }
1612
1613                 read_unlock(&ksocknal_data.ksnd_global_lock);
1614
1615                 if (conn == NULL)
1616                         break;
1617
1618                 ksocknal_lib_push_conn (conn);
1619                 ksocknal_conn_decref(conn);
1620         }
1621 }
1622
1623 static int
1624 ksocknal_push(struct lnet_ni *ni, struct lnet_process_id id)
1625 {
1626         int lo;
1627         int hi;
1628         int bkt;
1629         int rc = -ENOENT;
1630
1631         if (id.nid != LNET_NID_ANY) {
1632                 lo = hash_min(id.nid, HASH_BITS(ksocknal_data.ksnd_peers));
1633                 hi = lo;
1634         } else {
1635                 lo = 0;
1636                 hi = HASH_SIZE(ksocknal_data.ksnd_peers) - 1;
1637         }
1638
1639         for (bkt = lo; bkt <= hi; bkt++) {
1640                 int peer_off; /* searching offset in peer_ni hash table */
1641
1642                 for (peer_off = 0; ; peer_off++) {
1643                         struct ksock_peer_ni *peer_ni;
1644                         int           i = 0;
1645
1646                         read_lock(&ksocknal_data.ksnd_global_lock);
1647                         hlist_for_each_entry(peer_ni,
1648                                              &ksocknal_data.ksnd_peers[bkt],
1649                                              ksnp_list) {
1650                                 if (!((id.nid == LNET_NID_ANY ||
1651                                        id.nid == peer_ni->ksnp_id.nid) &&
1652                                       (id.pid == LNET_PID_ANY ||
1653                                        id.pid == peer_ni->ksnp_id.pid)))
1654                                         continue;
1655
1656                                 if (i++ == peer_off) {
1657                                         ksocknal_peer_addref(peer_ni);
1658                                         break;
1659                                 }
1660                         }
1661                         read_unlock(&ksocknal_data.ksnd_global_lock);
1662
1663                         if (i <= peer_off) /* no match */
1664                                 break;
1665
1666                         rc = 0;
1667                         ksocknal_push_peer(peer_ni);
1668                         ksocknal_peer_decref(peer_ni);
1669                 }
1670         }
1671         return rc;
1672 }
1673
1674 int
1675 ksocknal_ctl(struct lnet_ni *ni, unsigned int cmd, void *arg)
1676 {
1677         struct lnet_process_id id = {0};
1678         struct libcfs_ioctl_data *data = arg;
1679         int rc;
1680
1681         switch(cmd) {
1682         case IOC_LIBCFS_GET_INTERFACE: {
1683                 struct ksock_net *net = ni->ni_data;
1684                 struct ksock_interface *iface;
1685                 struct sockaddr_in *sa;
1686
1687                 read_lock(&ksocknal_data.ksnd_global_lock);
1688
1689                 if (data->ioc_count >= 1) {
1690                         rc = -ENOENT;
1691                 } else {
1692                         rc = 0;
1693                         iface = &net->ksnn_interface;
1694
1695                         sa = (void *)&iface->ksni_addr;
1696                         if (sa->sin_family == AF_INET)
1697                                 data->ioc_u32[0] = ntohl(sa->sin_addr.s_addr);
1698                         else
1699                                 data->ioc_u32[0] = 0xFFFFFFFF;
1700                         data->ioc_u32[1] = iface->ksni_netmask;
1701                         data->ioc_u32[2] = iface->ksni_npeers;
1702                         data->ioc_u32[3] = iface->ksni_nroutes;
1703                 }
1704
1705                 read_unlock(&ksocknal_data.ksnd_global_lock);
1706                 return rc;
1707         }
1708
1709         case IOC_LIBCFS_GET_PEER: {
1710                 __u32            myip = 0;
1711                 __u32            ip = 0;
1712                 int              port = 0;
1713                 int              conn_count = 0;
1714                 int              share_count = 0;
1715
1716                 rc = ksocknal_get_peer_info(ni, data->ioc_count,
1717                                             &id, &myip, &ip, &port,
1718                                             &conn_count,  &share_count);
1719                 if (rc != 0)
1720                         return rc;
1721
1722                 data->ioc_nid    = id.nid;
1723                 data->ioc_count  = share_count;
1724                 data->ioc_u32[0] = ip;
1725                 data->ioc_u32[1] = port;
1726                 data->ioc_u32[2] = myip;
1727                 data->ioc_u32[3] = conn_count;
1728                 data->ioc_u32[4] = id.pid;
1729                 return 0;
1730         }
1731
1732         case IOC_LIBCFS_ADD_PEER: {
1733                 struct sockaddr_in sa = {.sin_family = AF_INET};
1734
1735                 id.nid = data->ioc_nid;
1736                 id.pid = LNET_PID_LUSTRE;
1737                 sa.sin_addr.s_addr = htonl(data->ioc_u32[0]);
1738                 sa.sin_port = htons(data->ioc_u32[1]);
1739                 return ksocknal_add_peer(ni, id, (struct sockaddr *)&sa);
1740         }
1741         case IOC_LIBCFS_DEL_PEER:
1742                 id.nid = data->ioc_nid;
1743                 id.pid = LNET_PID_ANY;
1744                 return ksocknal_del_peer (ni, id,
1745                                           data->ioc_u32[0]); /* IP */
1746
1747         case IOC_LIBCFS_GET_CONN: {
1748                 int           txmem;
1749                 int           rxmem;
1750                 int           nagle;
1751                 struct ksock_conn *conn = ksocknal_get_conn_by_idx(ni, data->ioc_count);
1752                 struct sockaddr_in *psa = (void *)&conn->ksnc_peeraddr;
1753                 struct sockaddr_in *mysa = (void *)&conn->ksnc_myaddr;
1754
1755                 if (conn == NULL)
1756                         return -ENOENT;
1757
1758                 ksocknal_lib_get_conn_tunables(conn, &txmem, &rxmem, &nagle);
1759
1760                 data->ioc_count  = txmem;
1761                 data->ioc_nid    = conn->ksnc_peer->ksnp_id.nid;
1762                 data->ioc_flags  = nagle;
1763                 if (psa->sin_family == AF_INET)
1764                         data->ioc_u32[0] = ntohl(psa->sin_addr.s_addr);
1765                 else
1766                         data->ioc_u32[0] = 0xFFFFFFFF;
1767                 data->ioc_u32[1] = rpc_get_port((struct sockaddr *)
1768                                                 &conn->ksnc_peeraddr);
1769                 if (mysa->sin_family == AF_INET)
1770                         data->ioc_u32[2] = ntohl(mysa->sin_addr.s_addr);
1771                 else
1772                         data->ioc_u32[2] = 0xFFFFFFFF;
1773                 data->ioc_u32[3] = conn->ksnc_type;
1774                 data->ioc_u32[4] = conn->ksnc_scheduler->kss_cpt;
1775                 data->ioc_u32[5] = rxmem;
1776                 data->ioc_u32[6] = conn->ksnc_peer->ksnp_id.pid;
1777                 ksocknal_conn_decref(conn);
1778                 return 0;
1779         }
1780
1781         case IOC_LIBCFS_CLOSE_CONNECTION:
1782                 id.nid = data->ioc_nid;
1783                 id.pid = LNET_PID_ANY;
1784                 return ksocknal_close_matching_conns (id,
1785                                                       data->ioc_u32[0]);
1786
1787         case IOC_LIBCFS_REGISTER_MYNID:
1788                 /* Ignore if this is a noop */
1789                 if (data->ioc_nid == ni->ni_nid)
1790                         return 0;
1791
1792                 CERROR("obsolete IOC_LIBCFS_REGISTER_MYNID: %s(%s)\n",
1793                        libcfs_nid2str(data->ioc_nid),
1794                        libcfs_nid2str(ni->ni_nid));
1795                 return -EINVAL;
1796
1797         case IOC_LIBCFS_PUSH_CONNECTION:
1798                 id.nid = data->ioc_nid;
1799                 id.pid = LNET_PID_ANY;
1800                 return ksocknal_push(ni, id);
1801
1802         default:
1803                 return -EINVAL;
1804         }
1805         /* not reached */
1806 }
1807
1808 static void
1809 ksocknal_free_buffers (void)
1810 {
1811         LASSERT (atomic_read(&ksocknal_data.ksnd_nactive_txs) == 0);
1812
1813         if (ksocknal_data.ksnd_schedulers != NULL)
1814                 cfs_percpt_free(ksocknal_data.ksnd_schedulers);
1815
1816         spin_lock(&ksocknal_data.ksnd_tx_lock);
1817
1818         if (!list_empty(&ksocknal_data.ksnd_idle_noop_txs)) {
1819                 LIST_HEAD(zlist);
1820                 struct ksock_tx *tx;
1821
1822                 list_splice_init(&ksocknal_data.ksnd_idle_noop_txs, &zlist);
1823                 spin_unlock(&ksocknal_data.ksnd_tx_lock);
1824
1825                 while (!list_empty(&zlist)) {
1826                         tx = list_entry(zlist.next, struct ksock_tx, tx_list);
1827                         list_del(&tx->tx_list);
1828                         LIBCFS_FREE(tx, tx->tx_desc_size);
1829                 }
1830         } else {
1831                 spin_unlock(&ksocknal_data.ksnd_tx_lock);
1832         }
1833 }
1834
1835 static void
1836 ksocknal_base_shutdown(void)
1837 {
1838         struct ksock_sched *sched;
1839         struct ksock_peer_ni *peer_ni;
1840         int i;
1841
1842         CDEBUG(D_MALLOC, "before NAL cleanup: kmem %lld\n",
1843                libcfs_kmem_read());
1844         LASSERT (ksocknal_data.ksnd_nnets == 0);
1845
1846         switch (ksocknal_data.ksnd_init) {
1847         default:
1848                 LASSERT(0);
1849                 /* fallthrough */
1850
1851         case SOCKNAL_INIT_ALL:
1852         case SOCKNAL_INIT_DATA:
1853                 hash_for_each(ksocknal_data.ksnd_peers, i, peer_ni, ksnp_list)
1854                         LASSERT(0);
1855
1856                 LASSERT(list_empty(&ksocknal_data.ksnd_nets));
1857                 LASSERT(list_empty(&ksocknal_data.ksnd_enomem_conns));
1858                 LASSERT(list_empty(&ksocknal_data.ksnd_zombie_conns));
1859                 LASSERT(list_empty(&ksocknal_data.ksnd_connd_connreqs));
1860                 LASSERT(list_empty(&ksocknal_data.ksnd_connd_routes));
1861
1862                 if (ksocknal_data.ksnd_schedulers != NULL) {
1863                         cfs_percpt_for_each(sched, i,
1864                                             ksocknal_data.ksnd_schedulers) {
1865
1866                                 LASSERT(list_empty(&sched->kss_tx_conns));
1867                                 LASSERT(list_empty(&sched->kss_rx_conns));
1868                                 LASSERT(list_empty(&sched->kss_zombie_noop_txs));
1869                                 LASSERT(sched->kss_nconns == 0);
1870                         }
1871                 }
1872
1873                 /* flag threads to terminate; wake and wait for them to die */
1874                 ksocknal_data.ksnd_shuttingdown = 1;
1875                 wake_up_all(&ksocknal_data.ksnd_connd_waitq);
1876                 wake_up(&ksocknal_data.ksnd_reaper_waitq);
1877
1878                 if (ksocknal_data.ksnd_schedulers != NULL) {
1879                         cfs_percpt_for_each(sched, i,
1880                                             ksocknal_data.ksnd_schedulers)
1881                                         wake_up_all(&sched->kss_waitq);
1882                 }
1883
1884                 wait_var_event_warning(&ksocknal_data.ksnd_nthreads,
1885                                        atomic_read(&ksocknal_data.ksnd_nthreads) == 0,
1886                                        "waiting for %d threads to terminate\n",
1887                                        atomic_read(&ksocknal_data.ksnd_nthreads));
1888
1889                 ksocknal_free_buffers();
1890
1891                 ksocknal_data.ksnd_init = SOCKNAL_INIT_NOTHING;
1892                 break;
1893         }
1894
1895         CDEBUG(D_MALLOC, "after NAL cleanup: kmem %lld\n",
1896                libcfs_kmem_read());
1897
1898         module_put(THIS_MODULE);
1899 }
1900
1901 static int
1902 ksocknal_base_startup(void)
1903 {
1904         struct ksock_sched *sched;
1905         int rc;
1906         int i;
1907
1908         LASSERT(ksocknal_data.ksnd_init == SOCKNAL_INIT_NOTHING);
1909         LASSERT(ksocknal_data.ksnd_nnets == 0);
1910
1911         memset(&ksocknal_data, 0, sizeof(ksocknal_data)); /* zero pointers */
1912
1913         hash_init(ksocknal_data.ksnd_peers);
1914
1915         rwlock_init(&ksocknal_data.ksnd_global_lock);
1916         INIT_LIST_HEAD(&ksocknal_data.ksnd_nets);
1917
1918         spin_lock_init(&ksocknal_data.ksnd_reaper_lock);
1919         INIT_LIST_HEAD(&ksocknal_data.ksnd_enomem_conns);
1920         INIT_LIST_HEAD(&ksocknal_data.ksnd_zombie_conns);
1921         INIT_LIST_HEAD(&ksocknal_data.ksnd_deathrow_conns);
1922         init_waitqueue_head(&ksocknal_data.ksnd_reaper_waitq);
1923
1924         spin_lock_init(&ksocknal_data.ksnd_connd_lock);
1925         INIT_LIST_HEAD(&ksocknal_data.ksnd_connd_connreqs);
1926         INIT_LIST_HEAD(&ksocknal_data.ksnd_connd_routes);
1927         init_waitqueue_head(&ksocknal_data.ksnd_connd_waitq);
1928
1929         spin_lock_init(&ksocknal_data.ksnd_tx_lock);
1930         INIT_LIST_HEAD(&ksocknal_data.ksnd_idle_noop_txs);
1931
1932         /* NB memset above zeros whole of ksocknal_data */
1933
1934         /* flag lists/ptrs/locks initialised */
1935         ksocknal_data.ksnd_init = SOCKNAL_INIT_DATA;
1936         if (!try_module_get(THIS_MODULE))
1937                 goto failed;
1938
1939         /* Create a scheduler block per available CPT */
1940         ksocknal_data.ksnd_schedulers = cfs_percpt_alloc(lnet_cpt_table(),
1941                                                          sizeof(*sched));
1942         if (ksocknal_data.ksnd_schedulers == NULL)
1943                 goto failed;
1944
1945         cfs_percpt_for_each(sched, i, ksocknal_data.ksnd_schedulers) {
1946                 int nthrs;
1947
1948                 /*
1949                  * make sure not to allocate more threads than there are
1950                  * cores/CPUs in teh CPT
1951                  */
1952                 nthrs = cfs_cpt_weight(lnet_cpt_table(), i);
1953                 if (*ksocknal_tunables.ksnd_nscheds > 0) {
1954                         nthrs = min(nthrs, *ksocknal_tunables.ksnd_nscheds);
1955                 } else {
1956                         /*
1957                          * max to half of CPUs, assume another half should be
1958                          * reserved for upper layer modules
1959                          */
1960                         nthrs = min(max(SOCKNAL_NSCHEDS, nthrs >> 1), nthrs);
1961                 }
1962
1963                 sched->kss_nthreads_max = nthrs;
1964                 sched->kss_cpt = i;
1965
1966                 spin_lock_init(&sched->kss_lock);
1967                 INIT_LIST_HEAD(&sched->kss_rx_conns);
1968                 INIT_LIST_HEAD(&sched->kss_tx_conns);
1969                 INIT_LIST_HEAD(&sched->kss_zombie_noop_txs);
1970                 init_waitqueue_head(&sched->kss_waitq);
1971         }
1972
1973         ksocknal_data.ksnd_connd_starting         = 0;
1974         ksocknal_data.ksnd_connd_failed_stamp     = 0;
1975         ksocknal_data.ksnd_connd_starting_stamp   = ktime_get_real_seconds();
1976         /* must have at least 2 connds to remain responsive to accepts while
1977          * connecting */
1978         if (*ksocknal_tunables.ksnd_nconnds < SOCKNAL_CONND_RESV + 1)
1979                 *ksocknal_tunables.ksnd_nconnds = SOCKNAL_CONND_RESV + 1;
1980
1981         if (*ksocknal_tunables.ksnd_nconnds_max <
1982             *ksocknal_tunables.ksnd_nconnds) {
1983                 ksocknal_tunables.ksnd_nconnds_max =
1984                         ksocknal_tunables.ksnd_nconnds;
1985         }
1986
1987         for (i = 0; i < *ksocknal_tunables.ksnd_nconnds; i++) {
1988                 char name[16];
1989                 spin_lock_bh(&ksocknal_data.ksnd_connd_lock);
1990                 ksocknal_data.ksnd_connd_starting++;
1991                 spin_unlock_bh(&ksocknal_data.ksnd_connd_lock);
1992
1993
1994                 snprintf(name, sizeof(name), "socknal_cd%02d", i);
1995                 rc = ksocknal_thread_start(ksocknal_connd,
1996                                            (void *)((uintptr_t)i), name);
1997                 if (rc != 0) {
1998                         spin_lock_bh(&ksocknal_data.ksnd_connd_lock);
1999                         ksocknal_data.ksnd_connd_starting--;
2000                         spin_unlock_bh(&ksocknal_data.ksnd_connd_lock);
2001                         CERROR("Can't spawn socknal connd: %d\n", rc);
2002                         goto failed;
2003                 }
2004         }
2005
2006         rc = ksocknal_thread_start(ksocknal_reaper, NULL, "socknal_reaper");
2007         if (rc != 0) {
2008                 CERROR ("Can't spawn socknal reaper: %d\n", rc);
2009                 goto failed;
2010         }
2011
2012         /* flag everything initialised */
2013         ksocknal_data.ksnd_init = SOCKNAL_INIT_ALL;
2014
2015         return 0;
2016
2017  failed:
2018         ksocknal_base_shutdown();
2019         return -ENETDOWN;
2020 }
2021
2022 static int
2023 ksocknal_debug_peerhash(struct lnet_ni *ni)
2024 {
2025         struct ksock_peer_ni *peer_ni;
2026         int i;
2027
2028         read_lock(&ksocknal_data.ksnd_global_lock);
2029
2030         hash_for_each(ksocknal_data.ksnd_peers, i, peer_ni, ksnp_list) {
2031                 struct ksock_conn_cb *conn_cb;
2032                 struct ksock_conn *conn;
2033
2034                 if (peer_ni->ksnp_ni != ni)
2035                         continue;
2036
2037                 CWARN("Active peer_ni on shutdown: %s, ref %d, "
2038                       "closing %d, accepting %d, err %d, zcookie %llu, "
2039                       "txq %d, zc_req %d\n", libcfs_id2str(peer_ni->ksnp_id),
2040                       refcount_read(&peer_ni->ksnp_refcount),
2041                       peer_ni->ksnp_closing,
2042                       peer_ni->ksnp_accepting, peer_ni->ksnp_error,
2043                       peer_ni->ksnp_zc_next_cookie,
2044                       !list_empty(&peer_ni->ksnp_tx_queue),
2045                       !list_empty(&peer_ni->ksnp_zc_req_list));
2046
2047                 conn_cb = peer_ni->ksnp_conn_cb;
2048                 if (conn_cb) {
2049                         CWARN("ConnCB: ref %d, schd %d, conn %d, cnted %d, del %d\n",
2050                               refcount_read(&conn_cb->ksnr_refcount),
2051                               conn_cb->ksnr_scheduled, conn_cb->ksnr_connecting,
2052                               conn_cb->ksnr_connected, conn_cb->ksnr_deleted);
2053                 }
2054
2055                 list_for_each_entry(conn, &peer_ni->ksnp_conns, ksnc_list) {
2056                         CWARN("Conn: ref %d, sref %d, t %d, c %d\n",
2057                               refcount_read(&conn->ksnc_conn_refcount),
2058                               refcount_read(&conn->ksnc_sock_refcount),
2059                               conn->ksnc_type, conn->ksnc_closing);
2060                 }
2061                 break;
2062         }
2063
2064         read_unlock(&ksocknal_data.ksnd_global_lock);
2065         return 0;
2066 }
2067
2068 void
2069 ksocknal_shutdown(struct lnet_ni *ni)
2070 {
2071         struct ksock_net *net = ni->ni_data;
2072         struct lnet_process_id anyid = {
2073                 .nid = LNET_NID_ANY,
2074                 .pid = LNET_PID_ANY,
2075         };
2076
2077         LASSERT(ksocknal_data.ksnd_init == SOCKNAL_INIT_ALL);
2078         LASSERT(ksocknal_data.ksnd_nnets > 0);
2079
2080         /* prevent new peers */
2081         atomic_add(SOCKNAL_SHUTDOWN_BIAS, &net->ksnn_npeers);
2082
2083         /* Delete all peers */
2084         ksocknal_del_peer(ni, anyid, 0);
2085
2086         /* Wait for all peer_ni state to clean up */
2087         wait_var_event_warning(&net->ksnn_npeers,
2088                                atomic_read(&net->ksnn_npeers) ==
2089                                SOCKNAL_SHUTDOWN_BIAS,
2090                                "waiting for %d peers to disconnect\n",
2091                                ksocknal_debug_peerhash(ni) +
2092                                atomic_read(&net->ksnn_npeers) -
2093                                SOCKNAL_SHUTDOWN_BIAS);
2094
2095         LASSERT(net->ksnn_interface.ksni_npeers == 0);
2096         LASSERT(net->ksnn_interface.ksni_nroutes == 0);
2097
2098         list_del(&net->ksnn_list);
2099         LIBCFS_FREE(net, sizeof(*net));
2100
2101         ksocknal_data.ksnd_nnets--;
2102         if (ksocknal_data.ksnd_nnets == 0)
2103                 ksocknal_base_shutdown();
2104 }
2105
2106 static int
2107 ksocknal_search_new_ipif(struct ksock_net *net)
2108 {
2109         int new_ipif = 0;
2110         char *ifnam = &net->ksnn_interface.ksni_name[0];
2111         char *colon = strchr(ifnam, ':');
2112         bool found = false;
2113         struct ksock_net *tmp;
2114
2115         if (colon != NULL)
2116                 *colon = 0;
2117
2118         list_for_each_entry(tmp, &ksocknal_data.ksnd_nets, ksnn_list) {
2119                 char *ifnam2 = &tmp->ksnn_interface.ksni_name[0];
2120                 char *colon2 = strchr(ifnam2, ':');
2121
2122                 if (colon2 != NULL)
2123                         *colon2 = 0;
2124
2125                 found = strcmp(ifnam, ifnam2) == 0;
2126                 if (colon2 != NULL)
2127                         *colon2 = ':';
2128         }
2129
2130         new_ipif += !found;
2131         if (colon != NULL)
2132                 *colon = ':';
2133
2134         return new_ipif;
2135 }
2136
2137 static int
2138 ksocknal_start_schedulers(struct ksock_sched *sched)
2139 {
2140         int     nthrs;
2141         int     rc = 0;
2142         int     i;
2143
2144         if (sched->kss_nthreads == 0) {
2145                 if (*ksocknal_tunables.ksnd_nscheds > 0) {
2146                         nthrs = sched->kss_nthreads_max;
2147                 } else {
2148                         nthrs = cfs_cpt_weight(lnet_cpt_table(),
2149                                                sched->kss_cpt);
2150                         nthrs = min(max(SOCKNAL_NSCHEDS, nthrs >> 1), nthrs);
2151                         nthrs = min(SOCKNAL_NSCHEDS_HIGH, nthrs);
2152                 }
2153                 nthrs = min(nthrs, sched->kss_nthreads_max);
2154         } else {
2155                 LASSERT(sched->kss_nthreads <= sched->kss_nthreads_max);
2156                 /* increase two threads if there is new interface */
2157                 nthrs = min(2, sched->kss_nthreads_max - sched->kss_nthreads);
2158         }
2159
2160         for (i = 0; i < nthrs; i++) {
2161                 long id;
2162                 char name[20];
2163
2164                 id = KSOCK_THREAD_ID(sched->kss_cpt, sched->kss_nthreads + i);
2165                 snprintf(name, sizeof(name), "socknal_sd%02d_%02d",
2166                          sched->kss_cpt, (int)KSOCK_THREAD_SID(id));
2167
2168                 rc = ksocknal_thread_start(ksocknal_scheduler,
2169                                            (void *)id, name);
2170                 if (rc == 0)
2171                         continue;
2172
2173                 CERROR("Can't spawn thread %d for scheduler[%d]: %d\n",
2174                        sched->kss_cpt, (int) KSOCK_THREAD_SID(id), rc);
2175                 break;
2176         }
2177
2178         sched->kss_nthreads += i;
2179         return rc;
2180 }
2181
2182 static int
2183 ksocknal_net_start_threads(struct ksock_net *net, __u32 *cpts, int ncpts)
2184 {
2185         int newif = ksocknal_search_new_ipif(net);
2186         int rc;
2187         int i;
2188
2189         if (ncpts > 0 && ncpts > cfs_cpt_number(lnet_cpt_table()))
2190                 return -EINVAL;
2191
2192         for (i = 0; i < ncpts; i++) {
2193                 struct ksock_sched *sched;
2194                 int cpt = (cpts == NULL) ? i : cpts[i];
2195
2196                 LASSERT(cpt < cfs_cpt_number(lnet_cpt_table()));
2197                 sched = ksocknal_data.ksnd_schedulers[cpt];
2198
2199                 if (!newif && sched->kss_nthreads > 0)
2200                         continue;
2201
2202                 rc = ksocknal_start_schedulers(sched);
2203                 if (rc != 0)
2204                         return rc;
2205         }
2206         return 0;
2207 }
2208
2209 int
2210 ksocknal_startup(struct lnet_ni *ni)
2211 {
2212         struct ksock_net *net;
2213         struct lnet_ioctl_config_lnd_cmn_tunables *net_tunables;
2214         struct ksock_interface *ksi = NULL;
2215         struct lnet_inetdev *ifaces = NULL;
2216         struct sockaddr_in *sa;
2217         int i = 0;
2218         int rc;
2219
2220         LASSERT (ni->ni_net->net_lnd == &the_ksocklnd);
2221         if (ksocknal_data.ksnd_init == SOCKNAL_INIT_NOTHING) {
2222                 rc = ksocknal_base_startup();
2223                 if (rc != 0)
2224                         return rc;
2225         }
2226         LIBCFS_ALLOC(net, sizeof(*net));
2227         if (net == NULL)
2228                 goto fail_0;
2229         net->ksnn_incarnation = ktime_get_real_ns();
2230         ni->ni_data = net;
2231         net_tunables = &ni->ni_net->net_tunables;
2232         if (net_tunables->lct_peer_timeout == -1)
2233                 net_tunables->lct_peer_timeout =
2234                         *ksocknal_tunables.ksnd_peertimeout;
2235
2236         if (net_tunables->lct_max_tx_credits == -1)
2237                 net_tunables->lct_max_tx_credits =
2238                         *ksocknal_tunables.ksnd_credits;
2239
2240         if (net_tunables->lct_peer_tx_credits == -1)
2241                 net_tunables->lct_peer_tx_credits =
2242                         *ksocknal_tunables.ksnd_peertxcredits;
2243
2244         if (net_tunables->lct_peer_tx_credits >
2245             net_tunables->lct_max_tx_credits)
2246                 net_tunables->lct_peer_tx_credits =
2247                         net_tunables->lct_max_tx_credits;
2248
2249         if (net_tunables->lct_peer_rtr_credits == -1)
2250                 net_tunables->lct_peer_rtr_credits =
2251                         *ksocknal_tunables.ksnd_peerrtrcredits;
2252
2253         rc = lnet_inet_enumerate(&ifaces, ni->ni_net_ns);
2254         if (rc < 0)
2255                 goto fail_1;
2256
2257         ksi = &net->ksnn_interface;
2258
2259         /* Use the first discovered interface or look in the list */
2260         if (ni->ni_interface) {
2261                 for (i = 0; i < rc; i++)
2262                         if (strcmp(ifaces[i].li_name, ni->ni_interface) == 0)
2263                                 break;
2264
2265                 /* ni_interfaces doesn't contain the interface we want */
2266                 if (i == rc) {
2267                         CERROR("ksocklnd: failed to find interface %s\n",
2268                                ni->ni_interface);
2269                         goto fail_1;
2270                 }
2271         }
2272
2273         ni->ni_dev_cpt = ifaces[i].li_cpt;
2274         sa = (void *)&ksi->ksni_addr;
2275         memset(sa, 0, sizeof(*sa));
2276         sa->sin_family = AF_INET;
2277         sa->sin_addr.s_addr = htonl(ifaces[i].li_ipaddr);
2278         ksi->ksni_index = ksocknal_ip2index((struct sockaddr *)sa, ni);
2279         ksi->ksni_netmask = ifaces[i].li_netmask;
2280         strlcpy(ksi->ksni_name, ifaces[i].li_name, sizeof(ksi->ksni_name));
2281
2282         /* call it before add it to ksocknal_data.ksnd_nets */
2283         rc = ksocknal_net_start_threads(net, ni->ni_cpts, ni->ni_ncpts);
2284         if (rc != 0)
2285                 goto fail_1;
2286
2287         LASSERT(ksi);
2288         LASSERT(ksi->ksni_addr.ss_family == AF_INET);
2289         ni->ni_nid = LNET_MKNID(
2290                 LNET_NIDNET(ni->ni_nid),
2291                 ntohl(((struct sockaddr_in *)
2292                        &ksi->ksni_addr)->sin_addr.s_addr));
2293         list_add(&net->ksnn_list, &ksocknal_data.ksnd_nets);
2294         ksocknal_data.ksnd_nnets++;
2295
2296         return 0;
2297
2298 fail_1:
2299         LIBCFS_FREE(net, sizeof(*net));
2300 fail_0:
2301         if (ksocknal_data.ksnd_nnets == 0)
2302                 ksocknal_base_shutdown();
2303
2304         return -ENETDOWN;
2305 }
2306
2307
2308 static void __exit ksocklnd_exit(void)
2309 {
2310         lnet_unregister_lnd(&the_ksocklnd);
2311 }
2312
2313 static const struct lnet_lnd the_ksocklnd = {
2314         .lnd_type               = SOCKLND,
2315         .lnd_startup            = ksocknal_startup,
2316         .lnd_shutdown           = ksocknal_shutdown,
2317         .lnd_ctl                = ksocknal_ctl,
2318         .lnd_send               = ksocknal_send,
2319         .lnd_recv               = ksocknal_recv,
2320         .lnd_notify_peer_down   = ksocknal_notify_gw_down,
2321         .lnd_accept             = ksocknal_accept,
2322 };
2323
2324 static int __init ksocklnd_init(void)
2325 {
2326         int rc;
2327
2328         /* check ksnr_connected/connecting field large enough */
2329         BUILD_BUG_ON(SOCKLND_CONN_NTYPES > 4);
2330         BUILD_BUG_ON(SOCKLND_CONN_ACK != SOCKLND_CONN_BULK_IN);
2331
2332         rc = ksocknal_tunables_init();
2333         if (rc != 0)
2334                 return rc;
2335
2336         lnet_register_lnd(&the_ksocklnd);
2337
2338         return 0;
2339 }
2340
2341 MODULE_AUTHOR("OpenSFS, Inc. <http://www.lustre.org/>");
2342 MODULE_DESCRIPTION("TCP Socket LNet Network Driver");
2343 MODULE_VERSION("2.8.0");
2344 MODULE_LICENSE("GPL");
2345
2346 module_init(ksocklnd_init);
2347 module_exit(ksocklnd_exit);