1 /* -*- mode: c; c-basic-offset: 8; -*-
3 * vim: noexpandtab sw=8 ts=8 sts=0:
5 * Copyright (C) 2004 Oracle. All rights reserved.
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
17 * You should have received a copy of the GNU General Public
18 * License along with this program; if not, write to the
19 * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
20 * Boston, MA 021110-1307, USA.
24 * Callers for this were originally written against a very simple synchronus
25 * API. This implementation reflects those simple callers. Some day I'm sure
26 * we'll need to move to a more robust posting/callback mechanism.
28 * Transmit calls pass in kernel virtual addresses and block copying this into
29 * the socket's tx buffers via a usual blocking sendmsg. They'll block waiting
30 * for a failed socket to timeout. TX callers can also pass in a poniter to an
31 * 'int' which gets filled with an errno off the wire in response to the
34 * Handlers for unsolicited messages are registered. Each socket has a page
35 * that incoming data is copied into. First the header, then the data.
36 * Handlers are called from only one thread with a reference to this per-socket
37 * page. This page is destroyed after the handler call, so it can't be
38 * referenced beyond the call. Handlers may block but are discouraged from
41 * Any framing errors (bad magic, large payload lengths) close a connection.
43 * Our sock_container holds the state we associate with a socket. It's current
44 * framing state is held there as well as the refcounting we do around when it
45 * is safe to tear down the socket. The socket is only finally torn down from
46 * the container when the container loses all of its references -- so as long
47 * as you hold a ref on the container you can trust that the socket is valid
48 * for use with kernel socket APIs.
50 * Connections are initiated between a pair of nodes when the node with the
51 * higher node number gets a heartbeat callback which indicates that the lower
52 * numbered node has started heartbeating. The lower numbered node is passive
53 * and only accepts the connection if the higher numbered node is heartbeating.
56 #include <linux/kernel.h>
57 #include <linux/jiffies.h>
58 #include <linux/slab.h>
59 #include <linux/idr.h>
60 #include <linux/kref.h>
61 #include <linux/net.h>
62 #include <linux/export.h>
65 #include <asm/uaccess.h>
67 #include "heartbeat.h"
69 #include "nodemanager.h"
70 #define MLOG_MASK_PREFIX ML_TCP
74 #include "tcp_internal.h"
76 #define SC_NODEF_FMT "node %s (num %u) at %pI4:%u"
77 #define SC_NODEF_ARGS(sc) sc->sc_node->nd_name, sc->sc_node->nd_num, \
78 &sc->sc_node->nd_ipv4_address, \
79 ntohs(sc->sc_node->nd_ipv4_port)
82 * In the following two log macros, the whitespace after the ',' just
83 * before ##args is intentional. Otherwise, gcc 2.95 will eat the
84 * previous token if args expands to nothing.
86 #define msglog(hdr, fmt, args...) do { \
87 typeof(hdr) __hdr = (hdr); \
88 mlog(ML_MSG, "[mag %u len %u typ %u stat %d sys_stat %d " \
89 "key %08x num %u] " fmt, \
90 be16_to_cpu(__hdr->magic), be16_to_cpu(__hdr->data_len), \
91 be16_to_cpu(__hdr->msg_type), be32_to_cpu(__hdr->status), \
92 be32_to_cpu(__hdr->sys_status), be32_to_cpu(__hdr->key), \
93 be32_to_cpu(__hdr->msg_num) , ##args); \
96 #define sclog(sc, fmt, args...) do { \
97 typeof(sc) __sc = (sc); \
98 mlog(ML_SOCKET, "[sc %p refs %d sock %p node %u page %p " \
99 "pg_off %zu] " fmt, __sc, \
100 atomic_read(&__sc->sc_kref.refcount), __sc->sc_sock, \
101 __sc->sc_node->nd_num, __sc->sc_page, __sc->sc_page_off , \
105 static DEFINE_RWLOCK(o2net_handler_lock
);
106 static struct rb_root o2net_handler_tree
= RB_ROOT
;
108 static struct o2net_node o2net_nodes
[O2NM_MAX_NODES
];
110 /* XXX someday we'll need better accounting */
111 static struct socket
*o2net_listen_sock
;
114 * listen work is only queued by the listening socket callbacks on the
115 * o2net_wq. teardown detaches the callbacks before destroying the workqueue.
116 * quorum work is queued as sock containers are shutdown.. stop_listening
117 * tears down all the node's sock containers, preventing future shutdowns
118 * and queued quroum work, before canceling delayed quorum work and
119 * destroying the work queue.
121 static struct workqueue_struct
*o2net_wq
;
122 static struct work_struct o2net_listen_work
;
124 static struct o2hb_callback_func o2net_hb_up
, o2net_hb_down
;
125 #define O2NET_HB_PRI 0x1
127 static struct o2net_handshake
*o2net_hand
;
128 static struct o2net_msg
*o2net_keep_req
, *o2net_keep_resp
;
130 static int o2net_sys_err_translations
[O2NET_ERR_MAX
] =
131 {[O2NET_ERR_NONE
] = 0,
132 [O2NET_ERR_NO_HNDLR
] = -ENOPROTOOPT
,
133 [O2NET_ERR_OVERFLOW
] = -EOVERFLOW
,
134 [O2NET_ERR_DIED
] = -EHOSTDOWN
,};
136 /* can't quite avoid *all* internal declarations :/ */
137 static void o2net_sc_connect_completed(struct work_struct
*work
);
138 static void o2net_rx_until_empty(struct work_struct
*work
);
139 static void o2net_shutdown_sc(struct work_struct
*work
);
140 static void o2net_listen_data_ready(struct sock
*sk
);
141 static void o2net_sc_send_keep_req(struct work_struct
*work
);
142 static void o2net_idle_timer(unsigned long data
);
143 static void o2net_sc_postpone_idle(struct o2net_sock_container
*sc
);
144 static void o2net_sc_reset_idle_timer(struct o2net_sock_container
*sc
);
146 #ifdef CONFIG_DEBUG_FS
147 static void o2net_init_nst(struct o2net_send_tracking
*nst
, u32 msgtype
,
148 u32 msgkey
, struct task_struct
*task
, u8 node
)
150 INIT_LIST_HEAD(&nst
->st_net_debug_item
);
152 nst
->st_msg_type
= msgtype
;
153 nst
->st_msg_key
= msgkey
;
157 static inline void o2net_set_nst_sock_time(struct o2net_send_tracking
*nst
)
159 nst
->st_sock_time
= ktime_get();
162 static inline void o2net_set_nst_send_time(struct o2net_send_tracking
*nst
)
164 nst
->st_send_time
= ktime_get();
167 static inline void o2net_set_nst_status_time(struct o2net_send_tracking
*nst
)
169 nst
->st_status_time
= ktime_get();
172 static inline void o2net_set_nst_sock_container(struct o2net_send_tracking
*nst
,
173 struct o2net_sock_container
*sc
)
178 static inline void o2net_set_nst_msg_id(struct o2net_send_tracking
*nst
,
184 static inline void o2net_set_sock_timer(struct o2net_sock_container
*sc
)
186 sc
->sc_tv_timer
= ktime_get();
189 static inline void o2net_set_data_ready_time(struct o2net_sock_container
*sc
)
191 sc
->sc_tv_data_ready
= ktime_get();
194 static inline void o2net_set_advance_start_time(struct o2net_sock_container
*sc
)
196 sc
->sc_tv_advance_start
= ktime_get();
199 static inline void o2net_set_advance_stop_time(struct o2net_sock_container
*sc
)
201 sc
->sc_tv_advance_stop
= ktime_get();
204 static inline void o2net_set_func_start_time(struct o2net_sock_container
*sc
)
206 sc
->sc_tv_func_start
= ktime_get();
209 static inline void o2net_set_func_stop_time(struct o2net_sock_container
*sc
)
211 sc
->sc_tv_func_stop
= ktime_get();
214 #else /* CONFIG_DEBUG_FS */
215 # define o2net_init_nst(a, b, c, d, e)
216 # define o2net_set_nst_sock_time(a)
217 # define o2net_set_nst_send_time(a)
218 # define o2net_set_nst_status_time(a)
219 # define o2net_set_nst_sock_container(a, b)
220 # define o2net_set_nst_msg_id(a, b)
221 # define o2net_set_sock_timer(a)
222 # define o2net_set_data_ready_time(a)
223 # define o2net_set_advance_start_time(a)
224 # define o2net_set_advance_stop_time(a)
225 # define o2net_set_func_start_time(a)
226 # define o2net_set_func_stop_time(a)
227 #endif /* CONFIG_DEBUG_FS */
229 #ifdef CONFIG_OCFS2_FS_STATS
230 static ktime_t
o2net_get_func_run_time(struct o2net_sock_container
*sc
)
232 return ktime_sub(sc
->sc_tv_func_stop
, sc
->sc_tv_func_start
);
235 static void o2net_update_send_stats(struct o2net_send_tracking
*nst
,
236 struct o2net_sock_container
*sc
)
238 sc
->sc_tv_status_total
= ktime_add(sc
->sc_tv_status_total
,
239 ktime_sub(ktime_get(),
240 nst
->st_status_time
));
241 sc
->sc_tv_send_total
= ktime_add(sc
->sc_tv_send_total
,
242 ktime_sub(nst
->st_status_time
,
244 sc
->sc_tv_acquiry_total
= ktime_add(sc
->sc_tv_acquiry_total
,
245 ktime_sub(nst
->st_send_time
,
250 static void o2net_update_recv_stats(struct o2net_sock_container
*sc
)
252 sc
->sc_tv_process_total
= ktime_add(sc
->sc_tv_process_total
,
253 o2net_get_func_run_time(sc
));
259 # define o2net_update_send_stats(a, b)
261 # define o2net_update_recv_stats(sc)
263 #endif /* CONFIG_OCFS2_FS_STATS */
265 static inline unsigned int o2net_reconnect_delay(void)
267 return o2nm_single_cluster
->cl_reconnect_delay_ms
;
270 static inline unsigned int o2net_keepalive_delay(void)
272 return o2nm_single_cluster
->cl_keepalive_delay_ms
;
275 static inline unsigned int o2net_idle_timeout(void)
277 return o2nm_single_cluster
->cl_idle_timeout_ms
;
280 static inline int o2net_sys_err_to_errno(enum o2net_system_error err
)
283 BUG_ON(err
>= O2NET_ERR_MAX
);
284 trans
= o2net_sys_err_translations
[err
];
286 /* Just in case we mess up the translation table above */
287 BUG_ON(err
!= O2NET_ERR_NONE
&& trans
== 0);
291 static struct o2net_node
* o2net_nn_from_num(u8 node_num
)
293 BUG_ON(node_num
>= ARRAY_SIZE(o2net_nodes
));
294 return &o2net_nodes
[node_num
];
297 static u8
o2net_num_from_nn(struct o2net_node
*nn
)
300 return nn
- o2net_nodes
;
303 /* ------------------------------------------------------------ */
305 static int o2net_prep_nsw(struct o2net_node
*nn
, struct o2net_status_wait
*nsw
)
309 spin_lock(&nn
->nn_lock
);
310 ret
= idr_alloc(&nn
->nn_status_idr
, nsw
, 0, 0, GFP_ATOMIC
);
313 list_add_tail(&nsw
->ns_node_item
, &nn
->nn_status_list
);
315 spin_unlock(&nn
->nn_lock
);
319 init_waitqueue_head(&nsw
->ns_wq
);
320 nsw
->ns_sys_status
= O2NET_ERR_NONE
;
325 static void o2net_complete_nsw_locked(struct o2net_node
*nn
,
326 struct o2net_status_wait
*nsw
,
327 enum o2net_system_error sys_status
,
330 assert_spin_locked(&nn
->nn_lock
);
332 if (!list_empty(&nsw
->ns_node_item
)) {
333 list_del_init(&nsw
->ns_node_item
);
334 nsw
->ns_sys_status
= sys_status
;
335 nsw
->ns_status
= status
;
336 idr_remove(&nn
->nn_status_idr
, nsw
->ns_id
);
337 wake_up(&nsw
->ns_wq
);
341 static void o2net_complete_nsw(struct o2net_node
*nn
,
342 struct o2net_status_wait
*nsw
,
343 u64 id
, enum o2net_system_error sys_status
,
346 spin_lock(&nn
->nn_lock
);
351 nsw
= idr_find(&nn
->nn_status_idr
, id
);
356 o2net_complete_nsw_locked(nn
, nsw
, sys_status
, status
);
359 spin_unlock(&nn
->nn_lock
);
363 static void o2net_complete_nodes_nsw(struct o2net_node
*nn
)
365 struct o2net_status_wait
*nsw
, *tmp
;
366 unsigned int num_kills
= 0;
368 assert_spin_locked(&nn
->nn_lock
);
370 list_for_each_entry_safe(nsw
, tmp
, &nn
->nn_status_list
, ns_node_item
) {
371 o2net_complete_nsw_locked(nn
, nsw
, O2NET_ERR_DIED
, 0);
375 mlog(0, "completed %d messages for node %u\n", num_kills
,
376 o2net_num_from_nn(nn
));
379 static int o2net_nsw_completed(struct o2net_node
*nn
,
380 struct o2net_status_wait
*nsw
)
383 spin_lock(&nn
->nn_lock
);
384 completed
= list_empty(&nsw
->ns_node_item
);
385 spin_unlock(&nn
->nn_lock
);
389 /* ------------------------------------------------------------ */
391 static void sc_kref_release(struct kref
*kref
)
393 struct o2net_sock_container
*sc
= container_of(kref
,
394 struct o2net_sock_container
, sc_kref
);
395 BUG_ON(timer_pending(&sc
->sc_idle_timeout
));
397 sclog(sc
, "releasing\n");
400 sock_release(sc
->sc_sock
);
404 o2nm_undepend_item(&sc
->sc_node
->nd_item
);
405 o2nm_node_put(sc
->sc_node
);
408 o2net_debug_del_sc(sc
);
411 __free_page(sc
->sc_page
);
415 static void sc_put(struct o2net_sock_container
*sc
)
418 kref_put(&sc
->sc_kref
, sc_kref_release
);
420 static void sc_get(struct o2net_sock_container
*sc
)
423 kref_get(&sc
->sc_kref
);
425 static struct o2net_sock_container
*sc_alloc(struct o2nm_node
*node
)
427 struct o2net_sock_container
*sc
, *ret
= NULL
;
428 struct page
*page
= NULL
;
431 page
= alloc_page(GFP_NOFS
);
432 sc
= kzalloc(sizeof(*sc
), GFP_NOFS
);
433 if (sc
== NULL
|| page
== NULL
)
436 kref_init(&sc
->sc_kref
);
440 /* pin the node item of the remote node */
441 status
= o2nm_depend_item(&node
->nd_item
);
447 INIT_WORK(&sc
->sc_connect_work
, o2net_sc_connect_completed
);
448 INIT_WORK(&sc
->sc_rx_work
, o2net_rx_until_empty
);
449 INIT_WORK(&sc
->sc_shutdown_work
, o2net_shutdown_sc
);
450 INIT_DELAYED_WORK(&sc
->sc_keepalive_work
, o2net_sc_send_keep_req
);
452 init_timer(&sc
->sc_idle_timeout
);
453 sc
->sc_idle_timeout
.function
= o2net_idle_timer
;
454 sc
->sc_idle_timeout
.data
= (unsigned long)sc
;
456 sclog(sc
, "alloced\n");
460 o2net_debug_add_sc(sc
);
472 /* ------------------------------------------------------------ */
474 static void o2net_sc_queue_work(struct o2net_sock_container
*sc
,
475 struct work_struct
*work
)
478 if (!queue_work(o2net_wq
, work
))
481 static void o2net_sc_queue_delayed_work(struct o2net_sock_container
*sc
,
482 struct delayed_work
*work
,
486 if (!queue_delayed_work(o2net_wq
, work
, delay
))
489 static void o2net_sc_cancel_delayed_work(struct o2net_sock_container
*sc
,
490 struct delayed_work
*work
)
492 if (cancel_delayed_work(work
))
496 static atomic_t o2net_connected_peers
= ATOMIC_INIT(0);
498 int o2net_num_connected_peers(void)
500 return atomic_read(&o2net_connected_peers
);
503 static void o2net_set_nn_state(struct o2net_node
*nn
,
504 struct o2net_sock_container
*sc
,
505 unsigned valid
, int err
)
507 int was_valid
= nn
->nn_sc_valid
;
508 int was_err
= nn
->nn_persistent_error
;
509 struct o2net_sock_container
*old_sc
= nn
->nn_sc
;
511 assert_spin_locked(&nn
->nn_lock
);
514 atomic_dec(&o2net_connected_peers
);
515 else if (!old_sc
&& sc
)
516 atomic_inc(&o2net_connected_peers
);
518 /* the node num comparison and single connect/accept path should stop
519 * an non-null sc from being overwritten with another */
520 BUG_ON(sc
&& nn
->nn_sc
&& nn
->nn_sc
!= sc
);
521 mlog_bug_on_msg(err
&& valid
, "err %d valid %u\n", err
, valid
);
522 mlog_bug_on_msg(valid
&& !sc
, "valid %u sc %p\n", valid
, sc
);
524 if (was_valid
&& !valid
&& err
== 0)
527 mlog(ML_CONN
, "node %u sc: %p -> %p, valid %u -> %u, err %d -> %d\n",
528 o2net_num_from_nn(nn
), nn
->nn_sc
, sc
, nn
->nn_sc_valid
, valid
,
529 nn
->nn_persistent_error
, err
);
532 nn
->nn_sc_valid
= valid
? 1 : 0;
533 nn
->nn_persistent_error
= err
;
535 /* mirrors o2net_tx_can_proceed() */
536 if (nn
->nn_persistent_error
|| nn
->nn_sc_valid
)
537 wake_up(&nn
->nn_sc_wq
);
539 if (!was_err
&& nn
->nn_persistent_error
) {
540 o2quo_conn_err(o2net_num_from_nn(nn
));
541 queue_delayed_work(o2net_wq
, &nn
->nn_still_up
,
542 msecs_to_jiffies(O2NET_QUORUM_DELAY_MS
));
545 if (was_valid
&& !valid
) {
547 printk(KERN_NOTICE
"o2net: No longer connected to "
548 SC_NODEF_FMT
"\n", SC_NODEF_ARGS(old_sc
));
549 o2net_complete_nodes_nsw(nn
);
552 if (!was_valid
&& valid
) {
553 o2quo_conn_up(o2net_num_from_nn(nn
));
554 cancel_delayed_work(&nn
->nn_connect_expired
);
555 printk(KERN_NOTICE
"o2net: %s " SC_NODEF_FMT
"\n",
556 o2nm_this_node() > sc
->sc_node
->nd_num
?
557 "Connected to" : "Accepted connection from",
561 /* trigger the connecting worker func as long as we're not valid,
562 * it will back off if it shouldn't connect. This can be called
563 * from node config teardown and so needs to be careful about
564 * the work queue actually being up. */
565 if (!valid
&& o2net_wq
) {
567 /* delay if we're within a RECONNECT_DELAY of the
569 delay
= (nn
->nn_last_connect_attempt
+
570 msecs_to_jiffies(o2net_reconnect_delay()))
572 if (delay
> msecs_to_jiffies(o2net_reconnect_delay()))
574 mlog(ML_CONN
, "queueing conn attempt in %lu jiffies\n", delay
);
575 queue_delayed_work(o2net_wq
, &nn
->nn_connect_work
, delay
);
578 * Delay the expired work after idle timeout.
580 * We might have lots of failed connection attempts that run
581 * through here but we only cancel the connect_expired work when
582 * a connection attempt succeeds. So only the first enqueue of
583 * the connect_expired work will do anything. The rest will see
584 * that it's already queued and do nothing.
586 delay
+= msecs_to_jiffies(o2net_idle_timeout());
587 queue_delayed_work(o2net_wq
, &nn
->nn_connect_expired
, delay
);
590 /* keep track of the nn's sc ref for the caller */
591 if ((old_sc
== NULL
) && sc
)
593 if (old_sc
&& (old_sc
!= sc
)) {
594 o2net_sc_queue_work(old_sc
, &old_sc
->sc_shutdown_work
);
599 /* see o2net_register_callbacks() */
600 static void o2net_data_ready(struct sock
*sk
)
602 void (*ready
)(struct sock
*sk
);
604 read_lock(&sk
->sk_callback_lock
);
605 if (sk
->sk_user_data
) {
606 struct o2net_sock_container
*sc
= sk
->sk_user_data
;
607 sclog(sc
, "data_ready hit\n");
608 o2net_set_data_ready_time(sc
);
609 o2net_sc_queue_work(sc
, &sc
->sc_rx_work
);
610 ready
= sc
->sc_data_ready
;
612 ready
= sk
->sk_data_ready
;
614 read_unlock(&sk
->sk_callback_lock
);
619 /* see o2net_register_callbacks() */
620 static void o2net_state_change(struct sock
*sk
)
622 void (*state_change
)(struct sock
*sk
);
623 struct o2net_sock_container
*sc
;
625 read_lock(&sk
->sk_callback_lock
);
626 sc
= sk
->sk_user_data
;
628 state_change
= sk
->sk_state_change
;
632 sclog(sc
, "state_change to %d\n", sk
->sk_state
);
634 state_change
= sc
->sc_state_change
;
636 switch(sk
->sk_state
) {
637 /* ignore connecting sockets as they make progress */
641 case TCP_ESTABLISHED
:
642 o2net_sc_queue_work(sc
, &sc
->sc_connect_work
);
645 printk(KERN_INFO
"o2net: Connection to " SC_NODEF_FMT
646 " shutdown, state %d\n",
647 SC_NODEF_ARGS(sc
), sk
->sk_state
);
648 o2net_sc_queue_work(sc
, &sc
->sc_shutdown_work
);
652 read_unlock(&sk
->sk_callback_lock
);
657 * we register callbacks so we can queue work on events before calling
658 * the original callbacks. our callbacks our careful to test user_data
659 * to discover when they've reaced with o2net_unregister_callbacks().
661 static void o2net_register_callbacks(struct sock
*sk
,
662 struct o2net_sock_container
*sc
)
664 write_lock_bh(&sk
->sk_callback_lock
);
666 /* accepted sockets inherit the old listen socket data ready */
667 if (sk
->sk_data_ready
== o2net_listen_data_ready
) {
668 sk
->sk_data_ready
= sk
->sk_user_data
;
669 sk
->sk_user_data
= NULL
;
672 BUG_ON(sk
->sk_user_data
!= NULL
);
673 sk
->sk_user_data
= sc
;
676 sc
->sc_data_ready
= sk
->sk_data_ready
;
677 sc
->sc_state_change
= sk
->sk_state_change
;
678 sk
->sk_data_ready
= o2net_data_ready
;
679 sk
->sk_state_change
= o2net_state_change
;
681 mutex_init(&sc
->sc_send_lock
);
683 write_unlock_bh(&sk
->sk_callback_lock
);
686 static int o2net_unregister_callbacks(struct sock
*sk
,
687 struct o2net_sock_container
*sc
)
691 write_lock_bh(&sk
->sk_callback_lock
);
692 if (sk
->sk_user_data
== sc
) {
694 sk
->sk_user_data
= NULL
;
695 sk
->sk_data_ready
= sc
->sc_data_ready
;
696 sk
->sk_state_change
= sc
->sc_state_change
;
698 write_unlock_bh(&sk
->sk_callback_lock
);
704 * this is a little helper that is called by callers who have seen a problem
705 * with an sc and want to detach it from the nn if someone already hasn't beat
706 * them to it. if an error is given then the shutdown will be persistent
707 * and pending transmits will be canceled.
709 static void o2net_ensure_shutdown(struct o2net_node
*nn
,
710 struct o2net_sock_container
*sc
,
713 spin_lock(&nn
->nn_lock
);
715 o2net_set_nn_state(nn
, NULL
, 0, err
);
716 spin_unlock(&nn
->nn_lock
);
720 * This work queue function performs the blocking parts of socket shutdown. A
721 * few paths lead here. set_nn_state will trigger this callback if it sees an
722 * sc detached from the nn. state_change will also trigger this callback
723 * directly when it sees errors. In that case we need to call set_nn_state
724 * ourselves as state_change couldn't get the nn_lock and call set_nn_state
727 static void o2net_shutdown_sc(struct work_struct
*work
)
729 struct o2net_sock_container
*sc
=
730 container_of(work
, struct o2net_sock_container
,
732 struct o2net_node
*nn
= o2net_nn_from_num(sc
->sc_node
->nd_num
);
734 sclog(sc
, "shutting down\n");
736 /* drop the callbacks ref and call shutdown only once */
737 if (o2net_unregister_callbacks(sc
->sc_sock
->sk
, sc
)) {
738 /* we shouldn't flush as we're in the thread, the
739 * races with pending sc work structs are harmless */
740 del_timer_sync(&sc
->sc_idle_timeout
);
741 o2net_sc_cancel_delayed_work(sc
, &sc
->sc_keepalive_work
);
743 kernel_sock_shutdown(sc
->sc_sock
, SHUT_RDWR
);
746 /* not fatal so failed connects before the other guy has our
747 * heartbeat can be retried */
748 o2net_ensure_shutdown(nn
, sc
, 0);
752 /* ------------------------------------------------------------ */
754 static int o2net_handler_cmp(struct o2net_msg_handler
*nmh
, u32 msg_type
,
757 int ret
= memcmp(&nmh
->nh_key
, &key
, sizeof(key
));
760 ret
= memcmp(&nmh
->nh_msg_type
, &msg_type
, sizeof(msg_type
));
765 static struct o2net_msg_handler
*
766 o2net_handler_tree_lookup(u32 msg_type
, u32 key
, struct rb_node
***ret_p
,
767 struct rb_node
**ret_parent
)
769 struct rb_node
**p
= &o2net_handler_tree
.rb_node
;
770 struct rb_node
*parent
= NULL
;
771 struct o2net_msg_handler
*nmh
, *ret
= NULL
;
776 nmh
= rb_entry(parent
, struct o2net_msg_handler
, nh_node
);
777 cmp
= o2net_handler_cmp(nmh
, msg_type
, key
);
791 if (ret_parent
!= NULL
)
792 *ret_parent
= parent
;
797 static void o2net_handler_kref_release(struct kref
*kref
)
799 struct o2net_msg_handler
*nmh
;
800 nmh
= container_of(kref
, struct o2net_msg_handler
, nh_kref
);
805 static void o2net_handler_put(struct o2net_msg_handler
*nmh
)
807 kref_put(&nmh
->nh_kref
, o2net_handler_kref_release
);
810 /* max_len is protection for the handler func. incoming messages won't
811 * be given to the handler if their payload is longer than the max. */
812 int o2net_register_handler(u32 msg_type
, u32 key
, u32 max_len
,
813 o2net_msg_handler_func
*func
, void *data
,
814 o2net_post_msg_handler_func
*post_func
,
815 struct list_head
*unreg_list
)
817 struct o2net_msg_handler
*nmh
= NULL
;
818 struct rb_node
**p
, *parent
;
821 if (max_len
> O2NET_MAX_PAYLOAD_BYTES
) {
822 mlog(0, "max_len for message handler out of range: %u\n",
829 mlog(0, "no message type provided: %u, %p\n", msg_type
, func
);
835 mlog(0, "no message handler provided: %u, %p\n",
841 nmh
= kzalloc(sizeof(struct o2net_msg_handler
), GFP_NOFS
);
848 nmh
->nh_func_data
= data
;
849 nmh
->nh_post_func
= post_func
;
850 nmh
->nh_msg_type
= msg_type
;
851 nmh
->nh_max_len
= max_len
;
853 /* the tree and list get this ref.. they're both removed in
854 * unregister when this ref is dropped */
855 kref_init(&nmh
->nh_kref
);
856 INIT_LIST_HEAD(&nmh
->nh_unregister_item
);
858 write_lock(&o2net_handler_lock
);
859 if (o2net_handler_tree_lookup(msg_type
, key
, &p
, &parent
))
862 rb_link_node(&nmh
->nh_node
, parent
, p
);
863 rb_insert_color(&nmh
->nh_node
, &o2net_handler_tree
);
864 list_add_tail(&nmh
->nh_unregister_item
, unreg_list
);
866 mlog(ML_TCP
, "registered handler func %p type %u key %08x\n",
867 func
, msg_type
, key
);
868 /* we've had some trouble with handlers seemingly vanishing. */
869 mlog_bug_on_msg(o2net_handler_tree_lookup(msg_type
, key
, &p
,
871 "couldn't find handler we *just* registered "
872 "for type %u key %08x\n", msg_type
, key
);
874 write_unlock(&o2net_handler_lock
);
884 EXPORT_SYMBOL_GPL(o2net_register_handler
);
886 void o2net_unregister_handler_list(struct list_head
*list
)
888 struct o2net_msg_handler
*nmh
, *n
;
890 write_lock(&o2net_handler_lock
);
891 list_for_each_entry_safe(nmh
, n
, list
, nh_unregister_item
) {
892 mlog(ML_TCP
, "unregistering handler func %p type %u key %08x\n",
893 nmh
->nh_func
, nmh
->nh_msg_type
, nmh
->nh_key
);
894 rb_erase(&nmh
->nh_node
, &o2net_handler_tree
);
895 list_del_init(&nmh
->nh_unregister_item
);
896 kref_put(&nmh
->nh_kref
, o2net_handler_kref_release
);
898 write_unlock(&o2net_handler_lock
);
900 EXPORT_SYMBOL_GPL(o2net_unregister_handler_list
);
902 static struct o2net_msg_handler
*o2net_handler_get(u32 msg_type
, u32 key
)
904 struct o2net_msg_handler
*nmh
;
906 read_lock(&o2net_handler_lock
);
907 nmh
= o2net_handler_tree_lookup(msg_type
, key
, NULL
, NULL
);
909 kref_get(&nmh
->nh_kref
);
910 read_unlock(&o2net_handler_lock
);
915 /* ------------------------------------------------------------ */
917 static int o2net_recv_tcp_msg(struct socket
*sock
, void *data
, size_t len
)
919 struct kvec vec
= { .iov_len
= len
, .iov_base
= data
, };
920 struct msghdr msg
= { .msg_flags
= MSG_DONTWAIT
, };
921 return kernel_recvmsg(sock
, &msg
, &vec
, 1, len
, msg
.msg_flags
);
924 static int o2net_send_tcp_msg(struct socket
*sock
, struct kvec
*vec
,
925 size_t veclen
, size_t total
)
935 ret
= kernel_sendmsg(sock
, &msg
, vec
, veclen
, total
);
936 if (likely(ret
== total
))
938 mlog(ML_ERROR
, "sendmsg returned %d instead of %zu\n", ret
, total
);
940 ret
= -EPIPE
; /* should be smarter, I bet */
942 mlog(0, "returning error: %d\n", ret
);
946 static void o2net_sendpage(struct o2net_sock_container
*sc
,
947 void *kmalloced_virt
,
950 struct o2net_node
*nn
= o2net_nn_from_num(sc
->sc_node
->nd_num
);
954 mutex_lock(&sc
->sc_send_lock
);
955 ret
= sc
->sc_sock
->ops
->sendpage(sc
->sc_sock
,
956 virt_to_page(kmalloced_virt
),
957 (long)kmalloced_virt
& ~PAGE_MASK
,
959 mutex_unlock(&sc
->sc_send_lock
);
962 if (ret
== (ssize_t
)-EAGAIN
) {
963 mlog(0, "sendpage of size %zu to " SC_NODEF_FMT
964 " returned EAGAIN\n", size
, SC_NODEF_ARGS(sc
));
968 mlog(ML_ERROR
, "sendpage of size %zu to " SC_NODEF_FMT
969 " failed with %zd\n", size
, SC_NODEF_ARGS(sc
), ret
);
970 o2net_ensure_shutdown(nn
, sc
, 0);
975 static void o2net_init_msg(struct o2net_msg
*msg
, u16 data_len
, u16 msg_type
, u32 key
)
977 memset(msg
, 0, sizeof(struct o2net_msg
));
978 msg
->magic
= cpu_to_be16(O2NET_MSG_MAGIC
);
979 msg
->data_len
= cpu_to_be16(data_len
);
980 msg
->msg_type
= cpu_to_be16(msg_type
);
981 msg
->sys_status
= cpu_to_be32(O2NET_ERR_NONE
);
983 msg
->key
= cpu_to_be32(key
);
986 static int o2net_tx_can_proceed(struct o2net_node
*nn
,
987 struct o2net_sock_container
**sc_ret
,
992 spin_lock(&nn
->nn_lock
);
993 if (nn
->nn_persistent_error
) {
996 *error
= nn
->nn_persistent_error
;
997 } else if (nn
->nn_sc_valid
) {
998 kref_get(&nn
->nn_sc
->sc_kref
);
1001 *sc_ret
= nn
->nn_sc
;
1004 spin_unlock(&nn
->nn_lock
);
1009 /* Get a map of all nodes to which this node is currently connected to */
1010 void o2net_fill_node_map(unsigned long *map
, unsigned bytes
)
1012 struct o2net_sock_container
*sc
;
1015 BUG_ON(bytes
< (BITS_TO_LONGS(O2NM_MAX_NODES
) * sizeof(unsigned long)));
1017 memset(map
, 0, bytes
);
1018 for (node
= 0; node
< O2NM_MAX_NODES
; ++node
) {
1019 o2net_tx_can_proceed(o2net_nn_from_num(node
), &sc
, &ret
);
1026 EXPORT_SYMBOL_GPL(o2net_fill_node_map
);
1028 int o2net_send_message_vec(u32 msg_type
, u32 key
, struct kvec
*caller_vec
,
1029 size_t caller_veclen
, u8 target_node
, int *status
)
1032 struct o2net_msg
*msg
= NULL
;
1033 size_t veclen
, caller_bytes
= 0;
1034 struct kvec
*vec
= NULL
;
1035 struct o2net_sock_container
*sc
= NULL
;
1036 struct o2net_node
*nn
= o2net_nn_from_num(target_node
);
1037 struct o2net_status_wait nsw
= {
1038 .ns_node_item
= LIST_HEAD_INIT(nsw
.ns_node_item
),
1040 struct o2net_send_tracking nst
;
1042 o2net_init_nst(&nst
, msg_type
, key
, current
, target_node
);
1044 if (o2net_wq
== NULL
) {
1045 mlog(0, "attempt to tx without o2netd running\n");
1050 if (caller_veclen
== 0) {
1051 mlog(0, "bad kvec array length\n");
1056 caller_bytes
= iov_length((struct iovec
*)caller_vec
, caller_veclen
);
1057 if (caller_bytes
> O2NET_MAX_PAYLOAD_BYTES
) {
1058 mlog(0, "total payload len %zu too large\n", caller_bytes
);
1063 if (target_node
== o2nm_this_node()) {
1068 o2net_debug_add_nst(&nst
);
1070 o2net_set_nst_sock_time(&nst
);
1072 wait_event(nn
->nn_sc_wq
, o2net_tx_can_proceed(nn
, &sc
, &ret
));
1076 o2net_set_nst_sock_container(&nst
, sc
);
1078 veclen
= caller_veclen
+ 1;
1079 vec
= kmalloc(sizeof(struct kvec
) * veclen
, GFP_ATOMIC
);
1081 mlog(0, "failed to %zu element kvec!\n", veclen
);
1086 msg
= kmalloc(sizeof(struct o2net_msg
), GFP_ATOMIC
);
1088 mlog(0, "failed to allocate a o2net_msg!\n");
1093 o2net_init_msg(msg
, caller_bytes
, msg_type
, key
);
1095 vec
[0].iov_len
= sizeof(struct o2net_msg
);
1096 vec
[0].iov_base
= msg
;
1097 memcpy(&vec
[1], caller_vec
, caller_veclen
* sizeof(struct kvec
));
1099 ret
= o2net_prep_nsw(nn
, &nsw
);
1103 msg
->msg_num
= cpu_to_be32(nsw
.ns_id
);
1104 o2net_set_nst_msg_id(&nst
, nsw
.ns_id
);
1106 o2net_set_nst_send_time(&nst
);
1108 /* finally, convert the message header to network byte-order
1110 mutex_lock(&sc
->sc_send_lock
);
1111 ret
= o2net_send_tcp_msg(sc
->sc_sock
, vec
, veclen
,
1112 sizeof(struct o2net_msg
) + caller_bytes
);
1113 mutex_unlock(&sc
->sc_send_lock
);
1114 msglog(msg
, "sending returned %d\n", ret
);
1116 mlog(0, "error returned from o2net_send_tcp_msg=%d\n", ret
);
1120 /* wait on other node's handler */
1121 o2net_set_nst_status_time(&nst
);
1122 wait_event(nsw
.ns_wq
, o2net_nsw_completed(nn
, &nsw
));
1124 o2net_update_send_stats(&nst
, sc
);
1126 /* Note that we avoid overwriting the callers status return
1127 * variable if a system error was reported on the other
1128 * side. Callers beware. */
1129 ret
= o2net_sys_err_to_errno(nsw
.ns_sys_status
);
1131 *status
= nsw
.ns_status
;
1133 mlog(0, "woken, returning system status %d, user status %d\n",
1134 ret
, nsw
.ns_status
);
1136 o2net_debug_del_nst(&nst
); /* must be before dropping sc and node */
1141 o2net_complete_nsw(nn
, &nsw
, 0, 0, 0);
1144 EXPORT_SYMBOL_GPL(o2net_send_message_vec
);
1146 int o2net_send_message(u32 msg_type
, u32 key
, void *data
, u32 len
,
1147 u8 target_node
, int *status
)
1153 return o2net_send_message_vec(msg_type
, key
, &vec
, 1,
1154 target_node
, status
);
1156 EXPORT_SYMBOL_GPL(o2net_send_message
);
1158 static int o2net_send_status_magic(struct socket
*sock
, struct o2net_msg
*hdr
,
1159 enum o2net_system_error syserr
, int err
)
1163 .iov_len
= sizeof(struct o2net_msg
),
1166 BUG_ON(syserr
>= O2NET_ERR_MAX
);
1168 /* leave other fields intact from the incoming message, msg_num
1170 hdr
->sys_status
= cpu_to_be32(syserr
);
1171 hdr
->status
= cpu_to_be32(err
);
1172 hdr
->magic
= cpu_to_be16(O2NET_MSG_STATUS_MAGIC
); // twiddle the magic
1175 msglog(hdr
, "about to send status magic %d\n", err
);
1176 /* hdr has been in host byteorder this whole time */
1177 return o2net_send_tcp_msg(sock
, &vec
, 1, sizeof(struct o2net_msg
));
1180 /* this returns -errno if the header was unknown or too large, etc.
1181 * after this is called the buffer us reused for the next message */
1182 static int o2net_process_message(struct o2net_sock_container
*sc
,
1183 struct o2net_msg
*hdr
)
1185 struct o2net_node
*nn
= o2net_nn_from_num(sc
->sc_node
->nd_num
);
1186 int ret
= 0, handler_status
;
1187 enum o2net_system_error syserr
;
1188 struct o2net_msg_handler
*nmh
= NULL
;
1189 void *ret_data
= NULL
;
1191 msglog(hdr
, "processing message\n");
1193 o2net_sc_postpone_idle(sc
);
1195 switch(be16_to_cpu(hdr
->magic
)) {
1196 case O2NET_MSG_STATUS_MAGIC
:
1197 /* special type for returning message status */
1198 o2net_complete_nsw(nn
, NULL
,
1199 be32_to_cpu(hdr
->msg_num
),
1200 be32_to_cpu(hdr
->sys_status
),
1201 be32_to_cpu(hdr
->status
));
1203 case O2NET_MSG_KEEP_REQ_MAGIC
:
1204 o2net_sendpage(sc
, o2net_keep_resp
,
1205 sizeof(*o2net_keep_resp
));
1207 case O2NET_MSG_KEEP_RESP_MAGIC
:
1209 case O2NET_MSG_MAGIC
:
1212 msglog(hdr
, "bad magic\n");
1218 /* find a handler for it */
1220 nmh
= o2net_handler_get(be16_to_cpu(hdr
->msg_type
),
1221 be32_to_cpu(hdr
->key
));
1223 mlog(ML_TCP
, "couldn't find handler for type %u key %08x\n",
1224 be16_to_cpu(hdr
->msg_type
), be32_to_cpu(hdr
->key
));
1225 syserr
= O2NET_ERR_NO_HNDLR
;
1229 syserr
= O2NET_ERR_NONE
;
1231 if (be16_to_cpu(hdr
->data_len
) > nmh
->nh_max_len
)
1232 syserr
= O2NET_ERR_OVERFLOW
;
1234 if (syserr
!= O2NET_ERR_NONE
)
1237 o2net_set_func_start_time(sc
);
1238 sc
->sc_msg_key
= be32_to_cpu(hdr
->key
);
1239 sc
->sc_msg_type
= be16_to_cpu(hdr
->msg_type
);
1240 handler_status
= (nmh
->nh_func
)(hdr
, sizeof(struct o2net_msg
) +
1241 be16_to_cpu(hdr
->data_len
),
1242 nmh
->nh_func_data
, &ret_data
);
1243 o2net_set_func_stop_time(sc
);
1245 o2net_update_recv_stats(sc
);
1248 /* this destroys the hdr, so don't use it after this */
1249 mutex_lock(&sc
->sc_send_lock
);
1250 ret
= o2net_send_status_magic(sc
->sc_sock
, hdr
, syserr
,
1252 mutex_unlock(&sc
->sc_send_lock
);
1254 mlog(0, "sending handler status %d, syserr %d returned %d\n",
1255 handler_status
, syserr
, ret
);
1258 BUG_ON(ret_data
!= NULL
&& nmh
->nh_post_func
== NULL
);
1259 if (nmh
->nh_post_func
)
1260 (nmh
->nh_post_func
)(handler_status
, nmh
->nh_func_data
,
1266 o2net_handler_put(nmh
);
1270 static int o2net_check_handshake(struct o2net_sock_container
*sc
)
1272 struct o2net_handshake
*hand
= page_address(sc
->sc_page
);
1273 struct o2net_node
*nn
= o2net_nn_from_num(sc
->sc_node
->nd_num
);
1275 if (hand
->protocol_version
!= cpu_to_be64(O2NET_PROTOCOL_VERSION
)) {
1276 printk(KERN_NOTICE
"o2net: " SC_NODEF_FMT
" Advertised net "
1277 "protocol version %llu but %llu is required. "
1278 "Disconnecting.\n", SC_NODEF_ARGS(sc
),
1279 (unsigned long long)be64_to_cpu(hand
->protocol_version
),
1280 O2NET_PROTOCOL_VERSION
);
1282 /* don't bother reconnecting if its the wrong version. */
1283 o2net_ensure_shutdown(nn
, sc
, -ENOTCONN
);
1288 * Ensure timeouts are consistent with other nodes, otherwise
1289 * we can end up with one node thinking that the other must be down,
1290 * but isn't. This can ultimately cause corruption.
1292 if (be32_to_cpu(hand
->o2net_idle_timeout_ms
) !=
1293 o2net_idle_timeout()) {
1294 printk(KERN_NOTICE
"o2net: " SC_NODEF_FMT
" uses a network "
1295 "idle timeout of %u ms, but we use %u ms locally. "
1296 "Disconnecting.\n", SC_NODEF_ARGS(sc
),
1297 be32_to_cpu(hand
->o2net_idle_timeout_ms
),
1298 o2net_idle_timeout());
1299 o2net_ensure_shutdown(nn
, sc
, -ENOTCONN
);
1303 if (be32_to_cpu(hand
->o2net_keepalive_delay_ms
) !=
1304 o2net_keepalive_delay()) {
1305 printk(KERN_NOTICE
"o2net: " SC_NODEF_FMT
" uses a keepalive "
1306 "delay of %u ms, but we use %u ms locally. "
1307 "Disconnecting.\n", SC_NODEF_ARGS(sc
),
1308 be32_to_cpu(hand
->o2net_keepalive_delay_ms
),
1309 o2net_keepalive_delay());
1310 o2net_ensure_shutdown(nn
, sc
, -ENOTCONN
);
1314 if (be32_to_cpu(hand
->o2hb_heartbeat_timeout_ms
) !=
1315 O2HB_MAX_WRITE_TIMEOUT_MS
) {
1316 printk(KERN_NOTICE
"o2net: " SC_NODEF_FMT
" uses a heartbeat "
1317 "timeout of %u ms, but we use %u ms locally. "
1318 "Disconnecting.\n", SC_NODEF_ARGS(sc
),
1319 be32_to_cpu(hand
->o2hb_heartbeat_timeout_ms
),
1320 O2HB_MAX_WRITE_TIMEOUT_MS
);
1321 o2net_ensure_shutdown(nn
, sc
, -ENOTCONN
);
1325 sc
->sc_handshake_ok
= 1;
1327 spin_lock(&nn
->nn_lock
);
1328 /* set valid and queue the idle timers only if it hasn't been
1329 * shut down already */
1330 if (nn
->nn_sc
== sc
) {
1331 o2net_sc_reset_idle_timer(sc
);
1332 atomic_set(&nn
->nn_timeout
, 0);
1333 o2net_set_nn_state(nn
, sc
, 1, 0);
1335 spin_unlock(&nn
->nn_lock
);
1337 /* shift everything up as though it wasn't there */
1338 sc
->sc_page_off
-= sizeof(struct o2net_handshake
);
1339 if (sc
->sc_page_off
)
1340 memmove(hand
, hand
+ 1, sc
->sc_page_off
);
1345 /* this demuxes the queued rx bytes into header or payload bits and calls
1346 * handlers as each full message is read off the socket. it returns -error,
1347 * == 0 eof, or > 0 for progress made.*/
1348 static int o2net_advance_rx(struct o2net_sock_container
*sc
)
1350 struct o2net_msg
*hdr
;
1355 sclog(sc
, "receiving\n");
1356 o2net_set_advance_start_time(sc
);
1358 if (unlikely(sc
->sc_handshake_ok
== 0)) {
1359 if(sc
->sc_page_off
< sizeof(struct o2net_handshake
)) {
1360 data
= page_address(sc
->sc_page
) + sc
->sc_page_off
;
1361 datalen
= sizeof(struct o2net_handshake
) - sc
->sc_page_off
;
1362 ret
= o2net_recv_tcp_msg(sc
->sc_sock
, data
, datalen
);
1364 sc
->sc_page_off
+= ret
;
1367 if (sc
->sc_page_off
== sizeof(struct o2net_handshake
)) {
1368 o2net_check_handshake(sc
);
1369 if (unlikely(sc
->sc_handshake_ok
== 0))
1375 /* do we need more header? */
1376 if (sc
->sc_page_off
< sizeof(struct o2net_msg
)) {
1377 data
= page_address(sc
->sc_page
) + sc
->sc_page_off
;
1378 datalen
= sizeof(struct o2net_msg
) - sc
->sc_page_off
;
1379 ret
= o2net_recv_tcp_msg(sc
->sc_sock
, data
, datalen
);
1381 sc
->sc_page_off
+= ret
;
1382 /* only swab incoming here.. we can
1383 * only get here once as we cross from
1384 * being under to over */
1385 if (sc
->sc_page_off
== sizeof(struct o2net_msg
)) {
1386 hdr
= page_address(sc
->sc_page
);
1387 if (be16_to_cpu(hdr
->data_len
) >
1388 O2NET_MAX_PAYLOAD_BYTES
)
1396 if (sc
->sc_page_off
< sizeof(struct o2net_msg
)) {
1397 /* oof, still don't have a header */
1401 /* this was swabbed above when we first read it */
1402 hdr
= page_address(sc
->sc_page
);
1404 msglog(hdr
, "at page_off %zu\n", sc
->sc_page_off
);
1406 /* do we need more payload? */
1407 if (sc
->sc_page_off
- sizeof(struct o2net_msg
) < be16_to_cpu(hdr
->data_len
)) {
1408 /* need more payload */
1409 data
= page_address(sc
->sc_page
) + sc
->sc_page_off
;
1410 datalen
= (sizeof(struct o2net_msg
) + be16_to_cpu(hdr
->data_len
)) -
1412 ret
= o2net_recv_tcp_msg(sc
->sc_sock
, data
, datalen
);
1414 sc
->sc_page_off
+= ret
;
1419 if (sc
->sc_page_off
- sizeof(struct o2net_msg
) == be16_to_cpu(hdr
->data_len
)) {
1420 /* we can only get here once, the first time we read
1421 * the payload.. so set ret to progress if the handler
1422 * works out. after calling this the message is toast */
1423 ret
= o2net_process_message(sc
, hdr
);
1426 sc
->sc_page_off
= 0;
1430 sclog(sc
, "ret = %d\n", ret
);
1431 o2net_set_advance_stop_time(sc
);
1435 /* this work func is triggerd by data ready. it reads until it can read no
1436 * more. it interprets 0, eof, as fatal. if data_ready hits while we're doing
1437 * our work the work struct will be marked and we'll be called again. */
1438 static void o2net_rx_until_empty(struct work_struct
*work
)
1440 struct o2net_sock_container
*sc
=
1441 container_of(work
, struct o2net_sock_container
, sc_rx_work
);
1445 ret
= o2net_advance_rx(sc
);
1448 if (ret
<= 0 && ret
!= -EAGAIN
) {
1449 struct o2net_node
*nn
= o2net_nn_from_num(sc
->sc_node
->nd_num
);
1450 sclog(sc
, "saw error %d, closing\n", ret
);
1451 /* not permanent so read failed handshake can retry */
1452 o2net_ensure_shutdown(nn
, sc
, 0);
1458 static int o2net_set_nodelay(struct socket
*sock
)
1467 * Dear unsuspecting programmer,
1469 * Don't use sock_setsockopt() for SOL_TCP. It doesn't check its level
1470 * argument and assumes SOL_SOCKET so, say, your TCP_NODELAY will
1471 * silently turn into SO_DEBUG.
1474 * Keeper of hilariously fragile interfaces.
1476 ret
= sock
->ops
->setsockopt(sock
, SOL_TCP
, TCP_NODELAY
,
1477 (char __user
*)&val
, sizeof(val
));
1483 static void o2net_initialize_handshake(void)
1485 o2net_hand
->o2hb_heartbeat_timeout_ms
= cpu_to_be32(
1486 O2HB_MAX_WRITE_TIMEOUT_MS
);
1487 o2net_hand
->o2net_idle_timeout_ms
= cpu_to_be32(o2net_idle_timeout());
1488 o2net_hand
->o2net_keepalive_delay_ms
= cpu_to_be32(
1489 o2net_keepalive_delay());
1490 o2net_hand
->o2net_reconnect_delay_ms
= cpu_to_be32(
1491 o2net_reconnect_delay());
1494 /* ------------------------------------------------------------ */
1496 /* called when a connect completes and after a sock is accepted. the
1497 * rx path will see the response and mark the sc valid */
1498 static void o2net_sc_connect_completed(struct work_struct
*work
)
1500 struct o2net_sock_container
*sc
=
1501 container_of(work
, struct o2net_sock_container
,
1504 mlog(ML_MSG
, "sc sending handshake with ver %llu id %llx\n",
1505 (unsigned long long)O2NET_PROTOCOL_VERSION
,
1506 (unsigned long long)be64_to_cpu(o2net_hand
->connector_id
));
1508 o2net_initialize_handshake();
1509 o2net_sendpage(sc
, o2net_hand
, sizeof(*o2net_hand
));
1513 /* this is called as a work_struct func. */
1514 static void o2net_sc_send_keep_req(struct work_struct
*work
)
1516 struct o2net_sock_container
*sc
=
1517 container_of(work
, struct o2net_sock_container
,
1518 sc_keepalive_work
.work
);
1520 o2net_sendpage(sc
, o2net_keep_req
, sizeof(*o2net_keep_req
));
1524 /* socket shutdown does a del_timer_sync against this as it tears down.
1525 * we can't start this timer until we've got to the point in sc buildup
1526 * where shutdown is going to be involved */
1527 static void o2net_idle_timer(unsigned long data
)
1529 struct o2net_sock_container
*sc
= (struct o2net_sock_container
*)data
;
1530 struct o2net_node
*nn
= o2net_nn_from_num(sc
->sc_node
->nd_num
);
1531 #ifdef CONFIG_DEBUG_FS
1532 unsigned long msecs
= ktime_to_ms(ktime_get()) -
1533 ktime_to_ms(sc
->sc_tv_timer
);
1535 unsigned long msecs
= o2net_idle_timeout();
1538 printk(KERN_NOTICE
"o2net: Connection to " SC_NODEF_FMT
" has been "
1539 "idle for %lu.%lu secs, shutting it down.\n", SC_NODEF_ARGS(sc
),
1540 msecs
/ 1000, msecs
% 1000);
1543 * Initialize the nn_timeout so that the next connection attempt
1544 * will continue in o2net_start_connect.
1546 atomic_set(&nn
->nn_timeout
, 1);
1548 o2net_sc_queue_work(sc
, &sc
->sc_shutdown_work
);
1551 static void o2net_sc_reset_idle_timer(struct o2net_sock_container
*sc
)
1553 o2net_sc_cancel_delayed_work(sc
, &sc
->sc_keepalive_work
);
1554 o2net_sc_queue_delayed_work(sc
, &sc
->sc_keepalive_work
,
1555 msecs_to_jiffies(o2net_keepalive_delay()));
1556 o2net_set_sock_timer(sc
);
1557 mod_timer(&sc
->sc_idle_timeout
,
1558 jiffies
+ msecs_to_jiffies(o2net_idle_timeout()));
1561 static void o2net_sc_postpone_idle(struct o2net_sock_container
*sc
)
1563 /* Only push out an existing timer */
1564 if (timer_pending(&sc
->sc_idle_timeout
))
1565 o2net_sc_reset_idle_timer(sc
);
1568 /* this work func is kicked whenever a path sets the nn state which doesn't
1569 * have valid set. This includes seeing hb come up, losing a connection,
1570 * having a connect attempt fail, etc. This centralizes the logic which decides
1571 * if a connect attempt should be made or if we should give up and all future
1572 * transmit attempts should fail */
1573 static void o2net_start_connect(struct work_struct
*work
)
1575 struct o2net_node
*nn
=
1576 container_of(work
, struct o2net_node
, nn_connect_work
.work
);
1577 struct o2net_sock_container
*sc
= NULL
;
1578 struct o2nm_node
*node
= NULL
, *mynode
= NULL
;
1579 struct socket
*sock
= NULL
;
1580 struct sockaddr_in myaddr
= {0, }, remoteaddr
= {0, };
1582 unsigned int timeout
;
1584 /* if we're greater we initiate tx, otherwise we accept */
1585 if (o2nm_this_node() <= o2net_num_from_nn(nn
))
1588 /* watch for racing with tearing a node down */
1589 node
= o2nm_get_node_by_num(o2net_num_from_nn(nn
));
1595 mynode
= o2nm_get_node_by_num(o2nm_this_node());
1596 if (mynode
== NULL
) {
1601 spin_lock(&nn
->nn_lock
);
1603 * see if we already have one pending or have given up.
1604 * For nn_timeout, it is set when we close the connection
1605 * because of the idle time out. So it means that we have
1606 * at least connected to that node successfully once,
1607 * now try to connect to it again.
1609 timeout
= atomic_read(&nn
->nn_timeout
);
1610 stop
= (nn
->nn_sc
||
1611 (nn
->nn_persistent_error
&&
1612 (nn
->nn_persistent_error
!= -ENOTCONN
|| timeout
== 0)));
1613 spin_unlock(&nn
->nn_lock
);
1617 nn
->nn_last_connect_attempt
= jiffies
;
1619 sc
= sc_alloc(node
);
1621 mlog(0, "couldn't allocate sc\n");
1626 ret
= sock_create(PF_INET
, SOCK_STREAM
, IPPROTO_TCP
, &sock
);
1628 mlog(0, "can't create socket: %d\n", ret
);
1631 sc
->sc_sock
= sock
; /* freed by sc_kref_release */
1633 sock
->sk
->sk_allocation
= GFP_ATOMIC
;
1635 myaddr
.sin_family
= AF_INET
;
1636 myaddr
.sin_addr
.s_addr
= mynode
->nd_ipv4_address
;
1637 myaddr
.sin_port
= htons(0); /* any port */
1639 ret
= sock
->ops
->bind(sock
, (struct sockaddr
*)&myaddr
,
1642 mlog(ML_ERROR
, "bind failed with %d at address %pI4\n",
1643 ret
, &mynode
->nd_ipv4_address
);
1647 ret
= o2net_set_nodelay(sc
->sc_sock
);
1649 mlog(ML_ERROR
, "setting TCP_NODELAY failed with %d\n", ret
);
1653 o2net_register_callbacks(sc
->sc_sock
->sk
, sc
);
1655 spin_lock(&nn
->nn_lock
);
1656 /* handshake completion will set nn->nn_sc_valid */
1657 o2net_set_nn_state(nn
, sc
, 0, 0);
1658 spin_unlock(&nn
->nn_lock
);
1660 remoteaddr
.sin_family
= AF_INET
;
1661 remoteaddr
.sin_addr
.s_addr
= node
->nd_ipv4_address
;
1662 remoteaddr
.sin_port
= node
->nd_ipv4_port
;
1664 ret
= sc
->sc_sock
->ops
->connect(sc
->sc_sock
,
1665 (struct sockaddr
*)&remoteaddr
,
1668 if (ret
== -EINPROGRESS
)
1673 printk(KERN_NOTICE
"o2net: Connect attempt to " SC_NODEF_FMT
1674 " failed with errno %d\n", SC_NODEF_ARGS(sc
), ret
);
1675 /* 0 err so that another will be queued and attempted
1676 * from set_nn_state */
1677 o2net_ensure_shutdown(nn
, sc
, 0);
1682 o2nm_node_put(node
);
1684 o2nm_node_put(mynode
);
1689 static void o2net_connect_expired(struct work_struct
*work
)
1691 struct o2net_node
*nn
=
1692 container_of(work
, struct o2net_node
, nn_connect_expired
.work
);
1694 spin_lock(&nn
->nn_lock
);
1695 if (!nn
->nn_sc_valid
) {
1696 printk(KERN_NOTICE
"o2net: No connection established with "
1697 "node %u after %u.%u seconds, giving up.\n",
1698 o2net_num_from_nn(nn
),
1699 o2net_idle_timeout() / 1000,
1700 o2net_idle_timeout() % 1000);
1702 o2net_set_nn_state(nn
, NULL
, 0, -ENOTCONN
);
1704 spin_unlock(&nn
->nn_lock
);
1707 static void o2net_still_up(struct work_struct
*work
)
1709 struct o2net_node
*nn
=
1710 container_of(work
, struct o2net_node
, nn_still_up
.work
);
1712 o2quo_hb_still_up(o2net_num_from_nn(nn
));
1715 /* ------------------------------------------------------------ */
1717 void o2net_disconnect_node(struct o2nm_node
*node
)
1719 struct o2net_node
*nn
= o2net_nn_from_num(node
->nd_num
);
1721 /* don't reconnect until it's heartbeating again */
1722 spin_lock(&nn
->nn_lock
);
1723 atomic_set(&nn
->nn_timeout
, 0);
1724 o2net_set_nn_state(nn
, NULL
, 0, -ENOTCONN
);
1725 spin_unlock(&nn
->nn_lock
);
1728 cancel_delayed_work(&nn
->nn_connect_expired
);
1729 cancel_delayed_work(&nn
->nn_connect_work
);
1730 cancel_delayed_work(&nn
->nn_still_up
);
1731 flush_workqueue(o2net_wq
);
1735 static void o2net_hb_node_down_cb(struct o2nm_node
*node
, int node_num
,
1738 o2quo_hb_down(node_num
);
1743 if (node_num
!= o2nm_this_node())
1744 o2net_disconnect_node(node
);
1746 BUG_ON(atomic_read(&o2net_connected_peers
) < 0);
1749 static void o2net_hb_node_up_cb(struct o2nm_node
*node
, int node_num
,
1752 struct o2net_node
*nn
= o2net_nn_from_num(node_num
);
1754 o2quo_hb_up(node_num
);
1758 /* ensure an immediate connect attempt */
1759 nn
->nn_last_connect_attempt
= jiffies
-
1760 (msecs_to_jiffies(o2net_reconnect_delay()) + 1);
1762 if (node_num
!= o2nm_this_node()) {
1763 /* believe it or not, accept and node hearbeating testing
1764 * can succeed for this node before we got here.. so
1765 * only use set_nn_state to clear the persistent error
1766 * if that hasn't already happened */
1767 spin_lock(&nn
->nn_lock
);
1768 atomic_set(&nn
->nn_timeout
, 0);
1769 if (nn
->nn_persistent_error
)
1770 o2net_set_nn_state(nn
, NULL
, 0, 0);
1771 spin_unlock(&nn
->nn_lock
);
1775 void o2net_unregister_hb_callbacks(void)
1777 o2hb_unregister_callback(NULL
, &o2net_hb_up
);
1778 o2hb_unregister_callback(NULL
, &o2net_hb_down
);
1781 int o2net_register_hb_callbacks(void)
1785 o2hb_setup_callback(&o2net_hb_down
, O2HB_NODE_DOWN_CB
,
1786 o2net_hb_node_down_cb
, NULL
, O2NET_HB_PRI
);
1787 o2hb_setup_callback(&o2net_hb_up
, O2HB_NODE_UP_CB
,
1788 o2net_hb_node_up_cb
, NULL
, O2NET_HB_PRI
);
1790 ret
= o2hb_register_callback(NULL
, &o2net_hb_up
);
1792 ret
= o2hb_register_callback(NULL
, &o2net_hb_down
);
1795 o2net_unregister_hb_callbacks();
1800 /* ------------------------------------------------------------ */
1802 static int o2net_accept_one(struct socket
*sock
, int *more
)
1805 struct sockaddr_in sin
;
1806 struct socket
*new_sock
= NULL
;
1807 struct o2nm_node
*node
= NULL
;
1808 struct o2nm_node
*local_node
= NULL
;
1809 struct o2net_sock_container
*sc
= NULL
;
1810 struct o2net_node
*nn
;
1812 BUG_ON(sock
== NULL
);
1814 ret
= sock_create_lite(sock
->sk
->sk_family
, sock
->sk
->sk_type
,
1815 sock
->sk
->sk_protocol
, &new_sock
);
1819 new_sock
->type
= sock
->type
;
1820 new_sock
->ops
= sock
->ops
;
1821 ret
= sock
->ops
->accept(sock
, new_sock
, O_NONBLOCK
);
1826 new_sock
->sk
->sk_allocation
= GFP_ATOMIC
;
1828 ret
= o2net_set_nodelay(new_sock
);
1830 mlog(ML_ERROR
, "setting TCP_NODELAY failed with %d\n", ret
);
1835 ret
= new_sock
->ops
->getname(new_sock
, (struct sockaddr
*) &sin
,
1840 node
= o2nm_get_node_by_ip(sin
.sin_addr
.s_addr
);
1842 printk(KERN_NOTICE
"o2net: Attempt to connect from unknown "
1843 "node at %pI4:%d\n", &sin
.sin_addr
.s_addr
,
1844 ntohs(sin
.sin_port
));
1849 if (o2nm_this_node() >= node
->nd_num
) {
1850 local_node
= o2nm_get_node_by_num(o2nm_this_node());
1852 printk(KERN_NOTICE
"o2net: Unexpected connect attempt "
1853 "seen at node '%s' (%u, %pI4:%d) from "
1854 "node '%s' (%u, %pI4:%d)\n",
1855 local_node
->nd_name
, local_node
->nd_num
,
1856 &(local_node
->nd_ipv4_address
),
1857 ntohs(local_node
->nd_ipv4_port
),
1859 node
->nd_num
, &sin
.sin_addr
.s_addr
,
1860 ntohs(sin
.sin_port
));
1865 /* this happens all the time when the other node sees our heartbeat
1866 * and tries to connect before we see their heartbeat */
1867 if (!o2hb_check_node_heartbeating_from_callback(node
->nd_num
)) {
1868 mlog(ML_CONN
, "attempt to connect from node '%s' at "
1869 "%pI4:%d but it isn't heartbeating\n",
1870 node
->nd_name
, &sin
.sin_addr
.s_addr
,
1871 ntohs(sin
.sin_port
));
1876 nn
= o2net_nn_from_num(node
->nd_num
);
1878 spin_lock(&nn
->nn_lock
);
1883 spin_unlock(&nn
->nn_lock
);
1885 printk(KERN_NOTICE
"o2net: Attempt to connect from node '%s' "
1886 "at %pI4:%d but it already has an open connection\n",
1887 node
->nd_name
, &sin
.sin_addr
.s_addr
,
1888 ntohs(sin
.sin_port
));
1892 sc
= sc_alloc(node
);
1898 sc
->sc_sock
= new_sock
;
1901 spin_lock(&nn
->nn_lock
);
1902 atomic_set(&nn
->nn_timeout
, 0);
1903 o2net_set_nn_state(nn
, sc
, 0, 0);
1904 spin_unlock(&nn
->nn_lock
);
1906 o2net_register_callbacks(sc
->sc_sock
->sk
, sc
);
1907 o2net_sc_queue_work(sc
, &sc
->sc_rx_work
);
1909 o2net_initialize_handshake();
1910 o2net_sendpage(sc
, o2net_hand
, sizeof(*o2net_hand
));
1914 sock_release(new_sock
);
1916 o2nm_node_put(node
);
1918 o2nm_node_put(local_node
);
1925 * This function is invoked in response to one or more
1926 * pending accepts at softIRQ level. We must drain the
1927 * entire que before returning.
1930 static void o2net_accept_many(struct work_struct
*work
)
1932 struct socket
*sock
= o2net_listen_sock
;
1937 * It is critical to note that due to interrupt moderation
1938 * at the network driver level, we can't assume to get a
1939 * softIRQ for every single conn since tcp SYN packets
1940 * can arrive back-to-back, and therefore many pending
1941 * accepts may result in just 1 softIRQ. If we terminate
1942 * the o2net_accept_one() loop upon seeing an err, what happens
1943 * to the rest of the conns in the queue? If no new SYN
1944 * arrives for hours, no softIRQ will be delivered,
1945 * and the connections will just sit in the queue.
1949 err
= o2net_accept_one(sock
, &more
);
1956 static void o2net_listen_data_ready(struct sock
*sk
)
1958 void (*ready
)(struct sock
*sk
);
1960 read_lock(&sk
->sk_callback_lock
);
1961 ready
= sk
->sk_user_data
;
1962 if (ready
== NULL
) { /* check for teardown race */
1963 ready
= sk
->sk_data_ready
;
1967 /* This callback may called twice when a new connection
1968 * is being established as a child socket inherits everything
1969 * from a parent LISTEN socket, including the data_ready cb of
1970 * the parent. This leads to a hazard. In o2net_accept_one()
1971 * we are still initializing the child socket but have not
1972 * changed the inherited data_ready callback yet when
1973 * data starts arriving.
1974 * We avoid this hazard by checking the state.
1975 * For the listening socket, the state will be TCP_LISTEN; for the new
1976 * socket, will be TCP_ESTABLISHED. Also, in this case,
1977 * sk->sk_user_data is not a valid function pointer.
1980 if (sk
->sk_state
== TCP_LISTEN
) {
1981 queue_work(o2net_wq
, &o2net_listen_work
);
1987 read_unlock(&sk
->sk_callback_lock
);
1992 static int o2net_open_listening_sock(__be32 addr
, __be16 port
)
1994 struct socket
*sock
= NULL
;
1996 struct sockaddr_in sin
= {
1997 .sin_family
= PF_INET
,
1998 .sin_addr
= { .s_addr
= addr
},
2002 ret
= sock_create(PF_INET
, SOCK_STREAM
, IPPROTO_TCP
, &sock
);
2004 printk(KERN_ERR
"o2net: Error %d while creating socket\n", ret
);
2008 sock
->sk
->sk_allocation
= GFP_ATOMIC
;
2010 write_lock_bh(&sock
->sk
->sk_callback_lock
);
2011 sock
->sk
->sk_user_data
= sock
->sk
->sk_data_ready
;
2012 sock
->sk
->sk_data_ready
= o2net_listen_data_ready
;
2013 write_unlock_bh(&sock
->sk
->sk_callback_lock
);
2015 o2net_listen_sock
= sock
;
2016 INIT_WORK(&o2net_listen_work
, o2net_accept_many
);
2018 sock
->sk
->sk_reuse
= SK_CAN_REUSE
;
2019 ret
= sock
->ops
->bind(sock
, (struct sockaddr
*)&sin
, sizeof(sin
));
2021 printk(KERN_ERR
"o2net: Error %d while binding socket at "
2022 "%pI4:%u\n", ret
, &addr
, ntohs(port
));
2026 ret
= sock
->ops
->listen(sock
, 64);
2028 printk(KERN_ERR
"o2net: Error %d while listening on %pI4:%u\n",
2029 ret
, &addr
, ntohs(port
));
2033 o2net_listen_sock
= NULL
;
2041 * called from node manager when we should bring up our network listening
2042 * socket. node manager handles all the serialization to only call this
2043 * once and to match it with o2net_stop_listening(). note,
2044 * o2nm_this_node() doesn't work yet as we're being called while it
2047 int o2net_start_listening(struct o2nm_node
*node
)
2051 BUG_ON(o2net_wq
!= NULL
);
2052 BUG_ON(o2net_listen_sock
!= NULL
);
2054 mlog(ML_KTHREAD
, "starting o2net thread...\n");
2055 o2net_wq
= create_singlethread_workqueue("o2net");
2056 if (o2net_wq
== NULL
) {
2057 mlog(ML_ERROR
, "unable to launch o2net thread\n");
2058 return -ENOMEM
; /* ? */
2061 ret
= o2net_open_listening_sock(node
->nd_ipv4_address
,
2062 node
->nd_ipv4_port
);
2064 destroy_workqueue(o2net_wq
);
2067 o2quo_conn_up(node
->nd_num
);
2072 /* again, o2nm_this_node() doesn't work here as we're involved in
2073 * tearing it down */
2074 void o2net_stop_listening(struct o2nm_node
*node
)
2076 struct socket
*sock
= o2net_listen_sock
;
2079 BUG_ON(o2net_wq
== NULL
);
2080 BUG_ON(o2net_listen_sock
== NULL
);
2082 /* stop the listening socket from generating work */
2083 write_lock_bh(&sock
->sk
->sk_callback_lock
);
2084 sock
->sk
->sk_data_ready
= sock
->sk
->sk_user_data
;
2085 sock
->sk
->sk_user_data
= NULL
;
2086 write_unlock_bh(&sock
->sk
->sk_callback_lock
);
2088 for (i
= 0; i
< ARRAY_SIZE(o2net_nodes
); i
++) {
2089 struct o2nm_node
*node
= o2nm_get_node_by_num(i
);
2091 o2net_disconnect_node(node
);
2092 o2nm_node_put(node
);
2096 /* finish all work and tear down the work queue */
2097 mlog(ML_KTHREAD
, "waiting for o2net thread to exit....\n");
2098 destroy_workqueue(o2net_wq
);
2101 sock_release(o2net_listen_sock
);
2102 o2net_listen_sock
= NULL
;
2104 o2quo_conn_err(node
->nd_num
);
2107 /* ------------------------------------------------------------ */
2109 int o2net_init(void)
2115 if (o2net_debugfs_init())
2118 o2net_hand
= kzalloc(sizeof(struct o2net_handshake
), GFP_KERNEL
);
2119 o2net_keep_req
= kzalloc(sizeof(struct o2net_msg
), GFP_KERNEL
);
2120 o2net_keep_resp
= kzalloc(sizeof(struct o2net_msg
), GFP_KERNEL
);
2121 if (!o2net_hand
|| !o2net_keep_req
|| !o2net_keep_resp
) {
2123 kfree(o2net_keep_req
);
2124 kfree(o2net_keep_resp
);
2128 o2net_hand
->protocol_version
= cpu_to_be64(O2NET_PROTOCOL_VERSION
);
2129 o2net_hand
->connector_id
= cpu_to_be64(1);
2131 o2net_keep_req
->magic
= cpu_to_be16(O2NET_MSG_KEEP_REQ_MAGIC
);
2132 o2net_keep_resp
->magic
= cpu_to_be16(O2NET_MSG_KEEP_RESP_MAGIC
);
2134 for (i
= 0; i
< ARRAY_SIZE(o2net_nodes
); i
++) {
2135 struct o2net_node
*nn
= o2net_nn_from_num(i
);
2137 atomic_set(&nn
->nn_timeout
, 0);
2138 spin_lock_init(&nn
->nn_lock
);
2139 INIT_DELAYED_WORK(&nn
->nn_connect_work
, o2net_start_connect
);
2140 INIT_DELAYED_WORK(&nn
->nn_connect_expired
,
2141 o2net_connect_expired
);
2142 INIT_DELAYED_WORK(&nn
->nn_still_up
, o2net_still_up
);
2143 /* until we see hb from a node we'll return einval */
2144 nn
->nn_persistent_error
= -ENOTCONN
;
2145 init_waitqueue_head(&nn
->nn_sc_wq
);
2146 idr_init(&nn
->nn_status_idr
);
2147 INIT_LIST_HEAD(&nn
->nn_status_list
);
2153 void o2net_exit(void)
2157 kfree(o2net_keep_req
);
2158 kfree(o2net_keep_resp
);
2159 o2net_debugfs_exit();