1b97bf3fdSPer Liden /* 2b97bf3fdSPer Liden * net/tipc/bcast.c: TIPC broadcast code 3b97bf3fdSPer Liden * 4078bec82SJon Paul Maloy * Copyright (c) 2004-2006, 2014, Ericsson AB 5b97bf3fdSPer Liden * Copyright (c) 2004, Intel Corporation. 62d627b92SAllan Stephens * Copyright (c) 2005, 2010-2011, Wind River Systems 7b97bf3fdSPer Liden * All rights reserved. 8b97bf3fdSPer Liden * 9b97bf3fdSPer Liden * Redistribution and use in source and binary forms, with or without 10b97bf3fdSPer Liden * modification, are permitted provided that the following conditions are met: 11b97bf3fdSPer Liden * 129ea1fd3cSPer Liden * 1. Redistributions of source code must retain the above copyright 139ea1fd3cSPer Liden * notice, this list of conditions and the following disclaimer. 149ea1fd3cSPer Liden * 2. Redistributions in binary form must reproduce the above copyright 159ea1fd3cSPer Liden * notice, this list of conditions and the following disclaimer in the 169ea1fd3cSPer Liden * documentation and/or other materials provided with the distribution. 179ea1fd3cSPer Liden * 3. Neither the names of the copyright holders nor the names of its 189ea1fd3cSPer Liden * contributors may be used to endorse or promote products derived from 199ea1fd3cSPer Liden * this software without specific prior written permission. 209ea1fd3cSPer Liden * 219ea1fd3cSPer Liden * Alternatively, this software may be distributed under the terms of the 229ea1fd3cSPer Liden * GNU General Public License ("GPL") version 2 as published by the Free 239ea1fd3cSPer Liden * Software Foundation. 24b97bf3fdSPer Liden * 25b97bf3fdSPer Liden * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 26b97bf3fdSPer Liden * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 27b97bf3fdSPer Liden * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 28b97bf3fdSPer Liden * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 29b97bf3fdSPer Liden * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 30b97bf3fdSPer Liden * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 31b97bf3fdSPer Liden * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 32b97bf3fdSPer Liden * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 33b97bf3fdSPer Liden * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 34b97bf3fdSPer Liden * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 35b97bf3fdSPer Liden * POSSIBILITY OF SUCH DAMAGE. 36b97bf3fdSPer Liden */ 37b97bf3fdSPer Liden 38b97bf3fdSPer Liden #include "core.h" 39b97bf3fdSPer Liden #include "link.h" 40078bec82SJon Paul Maloy #include "socket.h" 41078bec82SJon Paul Maloy #include "msg.h" 42b97bf3fdSPer Liden #include "bcast.h" 439f6bdcd4SAllan Stephens #include "name_distr.h" 44b97bf3fdSPer Liden 45b97bf3fdSPer Liden #define MAX_PKT_DEFAULT_MCAST 1500 /* bcast link max packet size (fixed) */ 46b97bf3fdSPer Liden #define BCLINK_WIN_DEFAULT 20 /* bcast link window size (default) */ 47987b58beSYing Xue #define BCBEARER MAX_BEARERS 48b97bf3fdSPer Liden 49b97bf3fdSPer Liden /** 507f9ab6acSPaul Gortmaker * struct tipc_bcbearer_pair - a pair of bearers used by broadcast link 51b97bf3fdSPer Liden * @primary: pointer to primary bearer 52b97bf3fdSPer Liden * @secondary: pointer to secondary bearer 53b97bf3fdSPer Liden * 54b97bf3fdSPer Liden * Bearers must have same priority and same set of reachable destinations 55b97bf3fdSPer Liden * to be paired. 56b97bf3fdSPer Liden */ 57b97bf3fdSPer Liden 587f9ab6acSPaul Gortmaker struct tipc_bcbearer_pair { 592d627b92SAllan Stephens struct tipc_bearer *primary; 602d627b92SAllan Stephens struct tipc_bearer *secondary; 61b97bf3fdSPer Liden }; 62b97bf3fdSPer Liden 63b97bf3fdSPer Liden /** 647f9ab6acSPaul Gortmaker * struct tipc_bcbearer - bearer used by broadcast link 65b97bf3fdSPer Liden * @bearer: (non-standard) broadcast bearer structure 66b97bf3fdSPer Liden * @media: (non-standard) broadcast media structure 67b97bf3fdSPer Liden * @bpairs: array of bearer pairs 6865f51ef0SAllan Stephens * @bpairs_temp: temporary array of bearer pairs used by tipc_bcbearer_sort() 6965f51ef0SAllan Stephens * @remains: temporary node map used by tipc_bcbearer_send() 7065f51ef0SAllan Stephens * @remains_new: temporary node map used tipc_bcbearer_send() 7165f51ef0SAllan Stephens * 7265f51ef0SAllan Stephens * Note: The fields labelled "temporary" are incorporated into the bearer 7365f51ef0SAllan Stephens * to avoid consuming potentially limited stack space through the use of 7465f51ef0SAllan Stephens * large local variables within multicast routines. Concurrent access is 75d69afc90SYing Xue * prevented through use of the spinlock "bclink_lock". 76b97bf3fdSPer Liden */ 777f9ab6acSPaul Gortmaker struct tipc_bcbearer { 782d627b92SAllan Stephens struct tipc_bearer bearer; 79358a0d1cSPaul Gortmaker struct tipc_media media; 807f9ab6acSPaul Gortmaker struct tipc_bcbearer_pair bpairs[MAX_BEARERS]; 817f9ab6acSPaul Gortmaker struct tipc_bcbearer_pair bpairs_temp[TIPC_MAX_LINK_PRI + 1]; 826c00055aSDavid S. Miller struct tipc_node_map remains; 836c00055aSDavid S. Miller struct tipc_node_map remains_new; 84b97bf3fdSPer Liden }; 85b97bf3fdSPer Liden 86b97bf3fdSPer Liden /** 876765fd67SPaul Gortmaker * struct tipc_bclink - link used for broadcast messages 88d69afc90SYing Xue * @lock: spinlock governing access to structure 89b97bf3fdSPer Liden * @link: (non-standard) broadcast link structure 90b97bf3fdSPer Liden * @node: (non-standard) node structure representing b'cast link's peer node 913f5a12bdSYing Xue * @flags: represent bclink states 92cd3decdfSAllan Stephens * @bcast_nodes: map of broadcast-capable nodes 9301d83eddSAllan Stephens * @retransmit_to: node that most recently requested a retransmit 94b97bf3fdSPer Liden * 95b97bf3fdSPer Liden * Handles sequence numbering, fragmentation, bundling, etc. 96b97bf3fdSPer Liden */ 976765fd67SPaul Gortmaker struct tipc_bclink { 98d69afc90SYing Xue spinlock_t lock; 99a18c4bc3SPaul Gortmaker struct tipc_link link; 1006c00055aSDavid S. Miller struct tipc_node node; 1013f5a12bdSYing Xue unsigned int flags; 102cd3decdfSAllan Stephens struct tipc_node_map bcast_nodes; 10301d83eddSAllan Stephens struct tipc_node *retransmit_to; 104b97bf3fdSPer Liden }; 105b97bf3fdSPer Liden 106eb8b00f5SYing Xue static struct tipc_bcbearer *bcbearer; 107eb8b00f5SYing Xue static struct tipc_bclink *bclink; 108eb8b00f5SYing Xue static struct tipc_link *bcl; 109c47e9b91SAllan Stephens 1103aec9cc9SAllan Stephens const char tipc_bclink_name[] = "broadcast-link"; 111b97bf3fdSPer Liden 11231e3c3f6Sstephen hemminger static void tipc_nmap_diff(struct tipc_node_map *nm_a, 11331e3c3f6Sstephen hemminger struct tipc_node_map *nm_b, 11431e3c3f6Sstephen hemminger struct tipc_node_map *nm_diff); 11528dd9418SYing Xue static void tipc_nmap_add(struct tipc_node_map *nm_ptr, u32 node); 11628dd9418SYing Xue static void tipc_nmap_remove(struct tipc_node_map *nm_ptr, u32 node); 117b97bf3fdSPer Liden 118d69afc90SYing Xue static void tipc_bclink_lock(void) 119d69afc90SYing Xue { 120d69afc90SYing Xue spin_lock_bh(&bclink->lock); 121d69afc90SYing Xue } 122d69afc90SYing Xue 123d69afc90SYing Xue static void tipc_bclink_unlock(void) 124d69afc90SYing Xue { 1253f5a12bdSYing Xue struct tipc_node *node = NULL; 1263f5a12bdSYing Xue 1273f5a12bdSYing Xue if (likely(!bclink->flags)) { 128d69afc90SYing Xue spin_unlock_bh(&bclink->lock); 1293f5a12bdSYing Xue return; 1303f5a12bdSYing Xue } 1313f5a12bdSYing Xue 1323f5a12bdSYing Xue if (bclink->flags & TIPC_BCLINK_RESET) { 1333f5a12bdSYing Xue bclink->flags &= ~TIPC_BCLINK_RESET; 1343f5a12bdSYing Xue node = tipc_bclink_retransmit_to(); 1353f5a12bdSYing Xue } 1363f5a12bdSYing Xue spin_unlock_bh(&bclink->lock); 1373f5a12bdSYing Xue 1383f5a12bdSYing Xue if (node) 1393f5a12bdSYing Xue tipc_link_reset_all(node); 1403f5a12bdSYing Xue } 1413f5a12bdSYing Xue 142078bec82SJon Paul Maloy uint tipc_bclink_get_mtu(void) 143078bec82SJon Paul Maloy { 144078bec82SJon Paul Maloy return MAX_PKT_DEFAULT_MCAST; 145078bec82SJon Paul Maloy } 146078bec82SJon Paul Maloy 1473f5a12bdSYing Xue void tipc_bclink_set_flags(unsigned int flags) 1483f5a12bdSYing Xue { 1493f5a12bdSYing Xue bclink->flags |= flags; 150d69afc90SYing Xue } 151d69afc90SYing Xue 15205790c64SSam Ravnborg static u32 bcbuf_acks(struct sk_buff *buf) 153b97bf3fdSPer Liden { 154880b005fSDavid S. Miller return (u32)(unsigned long)TIPC_SKB_CB(buf)->handle; 155b97bf3fdSPer Liden } 156b97bf3fdSPer Liden 15705790c64SSam Ravnborg static void bcbuf_set_acks(struct sk_buff *buf, u32 acks) 158b97bf3fdSPer Liden { 159880b005fSDavid S. Miller TIPC_SKB_CB(buf)->handle = (void *)(unsigned long)acks; 160b97bf3fdSPer Liden } 161b97bf3fdSPer Liden 16205790c64SSam Ravnborg static void bcbuf_decr_acks(struct sk_buff *buf) 163b97bf3fdSPer Liden { 164b97bf3fdSPer Liden bcbuf_set_acks(buf, bcbuf_acks(buf) - 1); 165b97bf3fdSPer Liden } 166b97bf3fdSPer Liden 167cd3decdfSAllan Stephens void tipc_bclink_add_node(u32 addr) 168cd3decdfSAllan Stephens { 169d69afc90SYing Xue tipc_bclink_lock(); 170cd3decdfSAllan Stephens tipc_nmap_add(&bclink->bcast_nodes, addr); 171d69afc90SYing Xue tipc_bclink_unlock(); 172cd3decdfSAllan Stephens } 173cd3decdfSAllan Stephens 174cd3decdfSAllan Stephens void tipc_bclink_remove_node(u32 addr) 175cd3decdfSAllan Stephens { 176d69afc90SYing Xue tipc_bclink_lock(); 177cd3decdfSAllan Stephens tipc_nmap_remove(&bclink->bcast_nodes, addr); 178d69afc90SYing Xue tipc_bclink_unlock(); 179cd3decdfSAllan Stephens } 180b97bf3fdSPer Liden 1815b1f7bdeSAllan Stephens static void bclink_set_last_sent(void) 1825b1f7bdeSAllan Stephens { 1835b1f7bdeSAllan Stephens if (bcl->next_out) 1845b1f7bdeSAllan Stephens bcl->fsm_msg_cnt = mod(buf_seqno(bcl->next_out) - 1); 1855b1f7bdeSAllan Stephens else 1865b1f7bdeSAllan Stephens bcl->fsm_msg_cnt = mod(bcl->next_out_no - 1); 1875b1f7bdeSAllan Stephens } 1885b1f7bdeSAllan Stephens 1895b1f7bdeSAllan Stephens u32 tipc_bclink_get_last_sent(void) 1905b1f7bdeSAllan Stephens { 1915b1f7bdeSAllan Stephens return bcl->fsm_msg_cnt; 1925b1f7bdeSAllan Stephens } 1935b1f7bdeSAllan Stephens 1947a54d4a9SAllan Stephens static void bclink_update_last_sent(struct tipc_node *node, u32 seqno) 195b97bf3fdSPer Liden { 1967a54d4a9SAllan Stephens node->bclink.last_sent = less_eq(node->bclink.last_sent, seqno) ? 1977a54d4a9SAllan Stephens seqno : node->bclink.last_sent; 198b97bf3fdSPer Liden } 199b97bf3fdSPer Liden 200b97bf3fdSPer Liden 2012c53040fSBen Hutchings /** 20201d83eddSAllan Stephens * tipc_bclink_retransmit_to - get most recent node to request retransmission 20301d83eddSAllan Stephens * 204d69afc90SYing Xue * Called with bclink_lock locked 20501d83eddSAllan Stephens */ 20601d83eddSAllan Stephens struct tipc_node *tipc_bclink_retransmit_to(void) 20701d83eddSAllan Stephens { 20801d83eddSAllan Stephens return bclink->retransmit_to; 20901d83eddSAllan Stephens } 21001d83eddSAllan Stephens 21101d83eddSAllan Stephens /** 212b97bf3fdSPer Liden * bclink_retransmit_pkt - retransmit broadcast packets 213b97bf3fdSPer Liden * @after: sequence number of last packet to *not* retransmit 214b97bf3fdSPer Liden * @to: sequence number of last packet to retransmit 215b97bf3fdSPer Liden * 216d69afc90SYing Xue * Called with bclink_lock locked 217b97bf3fdSPer Liden */ 218b97bf3fdSPer Liden static void bclink_retransmit_pkt(u32 after, u32 to) 219b97bf3fdSPer Liden { 22058dc55f2SYing Xue struct sk_buff *skb; 221b97bf3fdSPer Liden 22258dc55f2SYing Xue skb_queue_walk(&bcl->outqueue, skb) { 223703068eeSJon Maloy if (more(buf_seqno(skb), after)) { 224703068eeSJon Maloy tipc_link_retransmit(bcl, skb, mod(to - after)); 22558dc55f2SYing Xue break; 22658dc55f2SYing Xue } 227703068eeSJon Maloy } 228b97bf3fdSPer Liden } 229b97bf3fdSPer Liden 230b97bf3fdSPer Liden /** 231908344cdSJon Maloy * tipc_bclink_wakeup_users - wake up pending users 232908344cdSJon Maloy * 233908344cdSJon Maloy * Called with no locks taken 234908344cdSJon Maloy */ 235908344cdSJon Maloy void tipc_bclink_wakeup_users(void) 236908344cdSJon Maloy { 2374988bb4aSErik Hugne struct sk_buff *skb; 2384988bb4aSErik Hugne 2394988bb4aSErik Hugne while ((skb = skb_dequeue(&bclink->link.waiting_sks))) 2404988bb4aSErik Hugne tipc_sk_rcv(skb); 2414988bb4aSErik Hugne 242908344cdSJon Maloy } 243908344cdSJon Maloy 244908344cdSJon Maloy /** 2454323add6SPer Liden * tipc_bclink_acknowledge - handle acknowledgement of broadcast packets 246b97bf3fdSPer Liden * @n_ptr: node that sent acknowledgement info 247b97bf3fdSPer Liden * @acked: broadcast sequence # that has been acknowledged 248b97bf3fdSPer Liden * 249d69afc90SYing Xue * Node is locked, bclink_lock unlocked. 250b97bf3fdSPer Liden */ 2516c00055aSDavid S. Miller void tipc_bclink_acknowledge(struct tipc_node *n_ptr, u32 acked) 252b97bf3fdSPer Liden { 25358dc55f2SYing Xue struct sk_buff *skb, *tmp; 254b97bf3fdSPer Liden struct sk_buff *next; 255b97bf3fdSPer Liden unsigned int released = 0; 256b97bf3fdSPer Liden 257d69afc90SYing Xue tipc_bclink_lock(); 25836559591SAllan Stephens /* Bail out if tx queue is empty (no clean up is required) */ 25958dc55f2SYing Xue skb = skb_peek(&bcl->outqueue); 26058dc55f2SYing Xue if (!skb) 26136559591SAllan Stephens goto exit; 26236559591SAllan Stephens 26336559591SAllan Stephens /* Determine which messages need to be acknowledged */ 26436559591SAllan Stephens if (acked == INVALID_LINK_SEQ) { 26536559591SAllan Stephens /* 26636559591SAllan Stephens * Contact with specified node has been lost, so need to 26736559591SAllan Stephens * acknowledge sent messages only (if other nodes still exist) 26836559591SAllan Stephens * or both sent and unsent messages (otherwise) 26936559591SAllan Stephens */ 27036559591SAllan Stephens if (bclink->bcast_nodes.count) 27136559591SAllan Stephens acked = bcl->fsm_msg_cnt; 27236559591SAllan Stephens else 27336559591SAllan Stephens acked = bcl->next_out_no; 27436559591SAllan Stephens } else { 27536559591SAllan Stephens /* 27636559591SAllan Stephens * Bail out if specified sequence number does not correspond 27736559591SAllan Stephens * to a message that has been sent and not yet acknowledged 27836559591SAllan Stephens */ 27958dc55f2SYing Xue if (less(acked, buf_seqno(skb)) || 28036559591SAllan Stephens less(bcl->fsm_msg_cnt, acked) || 28136559591SAllan Stephens less_eq(acked, n_ptr->bclink.acked)) 28236559591SAllan Stephens goto exit; 28336559591SAllan Stephens } 28436559591SAllan Stephens 28536559591SAllan Stephens /* Skip over packets that node has previously acknowledged */ 28658dc55f2SYing Xue skb_queue_walk(&bcl->outqueue, skb) { 28758dc55f2SYing Xue if (more(buf_seqno(skb), n_ptr->bclink.acked)) 28858dc55f2SYing Xue break; 28958dc55f2SYing Xue } 290b97bf3fdSPer Liden 291b97bf3fdSPer Liden /* Update packets that node is now acknowledging */ 29258dc55f2SYing Xue skb_queue_walk_from_safe(&bcl->outqueue, skb, tmp) { 29358dc55f2SYing Xue if (more(buf_seqno(skb), acked)) 29458dc55f2SYing Xue break; 295b97bf3fdSPer Liden 29658dc55f2SYing Xue next = tipc_skb_queue_next(&bcl->outqueue, skb); 29758dc55f2SYing Xue if (skb != bcl->next_out) { 29858dc55f2SYing Xue bcbuf_decr_acks(skb); 29958dc55f2SYing Xue } else { 30058dc55f2SYing Xue bcbuf_set_acks(skb, 0); 30110745cd5SAllan Stephens bcl->next_out = next; 30210745cd5SAllan Stephens bclink_set_last_sent(); 30310745cd5SAllan Stephens } 30410745cd5SAllan Stephens 30558dc55f2SYing Xue if (bcbuf_acks(skb) == 0) { 30658dc55f2SYing Xue __skb_unlink(skb, &bcl->outqueue); 30758dc55f2SYing Xue kfree_skb(skb); 308b97bf3fdSPer Liden released = 1; 309b97bf3fdSPer Liden } 310b97bf3fdSPer Liden } 311b97bf3fdSPer Liden n_ptr->bclink.acked = acked; 312b97bf3fdSPer Liden 313b97bf3fdSPer Liden /* Try resolving broadcast link congestion, if necessary */ 3145b1f7bdeSAllan Stephens if (unlikely(bcl->next_out)) { 31547b4c9a8SYing Xue tipc_link_push_packets(bcl); 3165b1f7bdeSAllan Stephens bclink_set_last_sent(); 3175b1f7bdeSAllan Stephens } 31850100a5eSJon Paul Maloy if (unlikely(released && !skb_queue_empty(&bcl->waiting_sks))) 319908344cdSJon Maloy n_ptr->action_flags |= TIPC_WAKEUP_BCAST_USERS; 320908344cdSJon Maloy 32136559591SAllan Stephens exit: 322d69afc90SYing Xue tipc_bclink_unlock(); 323b97bf3fdSPer Liden } 324b97bf3fdSPer Liden 3252c53040fSBen Hutchings /** 3267a54d4a9SAllan Stephens * tipc_bclink_update_link_state - update broadcast link state 327b97bf3fdSPer Liden * 3287216cd94SYing Xue * RCU and node lock set 329b97bf3fdSPer Liden */ 3307a54d4a9SAllan Stephens void tipc_bclink_update_link_state(struct tipc_node *n_ptr, u32 last_sent) 331b97bf3fdSPer Liden { 332b97bf3fdSPer Liden struct sk_buff *buf; 333b97bf3fdSPer Liden 3347a54d4a9SAllan Stephens /* Ignore "stale" link state info */ 3357a54d4a9SAllan Stephens if (less_eq(last_sent, n_ptr->bclink.last_in)) 336b97bf3fdSPer Liden return; 337b97bf3fdSPer Liden 3387a54d4a9SAllan Stephens /* Update link synchronization state; quit if in sync */ 3397a54d4a9SAllan Stephens bclink_update_last_sent(n_ptr, last_sent); 3407a54d4a9SAllan Stephens 3417a54d4a9SAllan Stephens if (n_ptr->bclink.last_sent == n_ptr->bclink.last_in) 3427a54d4a9SAllan Stephens return; 3437a54d4a9SAllan Stephens 3447a54d4a9SAllan Stephens /* Update out-of-sync state; quit if loss is still unconfirmed */ 3457a54d4a9SAllan Stephens if ((++n_ptr->bclink.oos_state) == 1) { 3467a54d4a9SAllan Stephens if (n_ptr->bclink.deferred_size < (TIPC_MIN_LINK_WIN / 2)) 3477a54d4a9SAllan Stephens return; 3487a54d4a9SAllan Stephens n_ptr->bclink.oos_state++; 3497a54d4a9SAllan Stephens } 3507a54d4a9SAllan Stephens 3517a54d4a9SAllan Stephens /* Don't NACK if one has been recently sent (or seen) */ 3527a54d4a9SAllan Stephens if (n_ptr->bclink.oos_state & 0x1) 3537a54d4a9SAllan Stephens return; 3547a54d4a9SAllan Stephens 3557a54d4a9SAllan Stephens /* Send NACK */ 35631e3c3f6Sstephen hemminger buf = tipc_buf_acquire(INT_H_SIZE); 357b97bf3fdSPer Liden if (buf) { 3587a54d4a9SAllan Stephens struct tipc_msg *msg = buf_msg(buf); 359bc6fecd4SYing Xue struct sk_buff *skb = skb_peek(&n_ptr->bclink.deferred_queue); 360bc6fecd4SYing Xue u32 to = skb ? buf_seqno(skb) - 1 : n_ptr->bclink.last_sent; 3617a54d4a9SAllan Stephens 362c68ca7b7SAllan Stephens tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, 36375715217SAllan Stephens INT_H_SIZE, n_ptr->addr); 364bf781ecfSAllan Stephens msg_set_non_seq(msg, 1); 365b97bf3fdSPer Liden msg_set_mc_netid(msg, tipc_net_id); 3667a54d4a9SAllan Stephens msg_set_bcast_ack(msg, n_ptr->bclink.last_in); 3677a54d4a9SAllan Stephens msg_set_bcgap_after(msg, n_ptr->bclink.last_in); 368bc6fecd4SYing Xue msg_set_bcgap_to(msg, to); 369b97bf3fdSPer Liden 370d69afc90SYing Xue tipc_bclink_lock(); 3717a2f7d18SYing Xue tipc_bearer_send(MAX_BEARERS, buf, NULL); 372b97bf3fdSPer Liden bcl->stats.sent_nacks++; 373d69afc90SYing Xue tipc_bclink_unlock(); 3745f6d9123SAllan Stephens kfree_skb(buf); 375b97bf3fdSPer Liden 3767a54d4a9SAllan Stephens n_ptr->bclink.oos_state++; 3777a54d4a9SAllan Stephens } 3787a54d4a9SAllan Stephens } 3797a54d4a9SAllan Stephens 3802c53040fSBen Hutchings /** 3817a54d4a9SAllan Stephens * bclink_peek_nack - monitor retransmission requests sent by other nodes 382b97bf3fdSPer Liden * 3837a54d4a9SAllan Stephens * Delay any upcoming NACK by this node if another node has already 3847a54d4a9SAllan Stephens * requested the first message this node is going to ask for. 385b97bf3fdSPer Liden */ 3867a54d4a9SAllan Stephens static void bclink_peek_nack(struct tipc_msg *msg) 387b97bf3fdSPer Liden { 3887a54d4a9SAllan Stephens struct tipc_node *n_ptr = tipc_node_find(msg_destnode(msg)); 389b97bf3fdSPer Liden 3907a54d4a9SAllan Stephens if (unlikely(!n_ptr)) 391b97bf3fdSPer Liden return; 3927a54d4a9SAllan Stephens 3934323add6SPer Liden tipc_node_lock(n_ptr); 394b97bf3fdSPer Liden 395389dd9bcSYing Xue if (n_ptr->bclink.recv_permitted && 3967a54d4a9SAllan Stephens (n_ptr->bclink.last_in != n_ptr->bclink.last_sent) && 3977a54d4a9SAllan Stephens (n_ptr->bclink.last_in == msg_bcgap_after(msg))) 3987a54d4a9SAllan Stephens n_ptr->bclink.oos_state = 2; 399b97bf3fdSPer Liden 4004323add6SPer Liden tipc_node_unlock(n_ptr); 401b97bf3fdSPer Liden } 402b97bf3fdSPer Liden 4039fbfb8b1SJon Paul Maloy /* tipc_bclink_xmit - broadcast buffer chain to all nodes in cluster 404078bec82SJon Paul Maloy * and to identified node local sockets 405a6ca1094SYing Xue * @list: chain of buffers containing message 406078bec82SJon Paul Maloy * Consumes the buffer chain, except when returning -ELINKCONG 407078bec82SJon Paul Maloy * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE 408078bec82SJon Paul Maloy */ 409a6ca1094SYing Xue int tipc_bclink_xmit(struct sk_buff_head *list) 410078bec82SJon Paul Maloy { 411078bec82SJon Paul Maloy int rc = 0; 412078bec82SJon Paul Maloy int bc = 0; 413a6ca1094SYing Xue struct sk_buff *skb; 414078bec82SJon Paul Maloy 415078bec82SJon Paul Maloy /* Prepare clone of message for local node */ 416a6ca1094SYing Xue skb = tipc_msg_reassemble(list); 417a6ca1094SYing Xue if (unlikely(!skb)) { 418a6ca1094SYing Xue __skb_queue_purge(list); 419078bec82SJon Paul Maloy return -EHOSTUNREACH; 420078bec82SJon Paul Maloy } 421078bec82SJon Paul Maloy 422078bec82SJon Paul Maloy /* Broadcast to all other nodes */ 423078bec82SJon Paul Maloy if (likely(bclink)) { 424078bec82SJon Paul Maloy tipc_bclink_lock(); 425078bec82SJon Paul Maloy if (likely(bclink->bcast_nodes.count)) { 426a6ca1094SYing Xue rc = __tipc_link_xmit(bcl, list); 427078bec82SJon Paul Maloy if (likely(!rc)) { 42858dc55f2SYing Xue u32 len = skb_queue_len(&bcl->outqueue); 42958dc55f2SYing Xue 430078bec82SJon Paul Maloy bclink_set_last_sent(); 431078bec82SJon Paul Maloy bcl->stats.queue_sz_counts++; 43258dc55f2SYing Xue bcl->stats.accu_queue_sz += len; 433078bec82SJon Paul Maloy } 434078bec82SJon Paul Maloy bc = 1; 435078bec82SJon Paul Maloy } 436078bec82SJon Paul Maloy tipc_bclink_unlock(); 437078bec82SJon Paul Maloy } 438078bec82SJon Paul Maloy 439078bec82SJon Paul Maloy if (unlikely(!bc)) 440a6ca1094SYing Xue __skb_queue_purge(list); 441078bec82SJon Paul Maloy 442078bec82SJon Paul Maloy /* Deliver message clone */ 443078bec82SJon Paul Maloy if (likely(!rc)) 444a6ca1094SYing Xue tipc_sk_mcast_rcv(skb); 445078bec82SJon Paul Maloy else 446a6ca1094SYing Xue kfree_skb(skb); 447078bec82SJon Paul Maloy 448078bec82SJon Paul Maloy return rc; 449078bec82SJon Paul Maloy } 450078bec82SJon Paul Maloy 4512c53040fSBen Hutchings /** 45263e7f1acSAllan Stephens * bclink_accept_pkt - accept an incoming, in-sequence broadcast packet 45363e7f1acSAllan Stephens * 454d69afc90SYing Xue * Called with both sending node's lock and bclink_lock taken. 45563e7f1acSAllan Stephens */ 45663e7f1acSAllan Stephens static void bclink_accept_pkt(struct tipc_node *node, u32 seqno) 45763e7f1acSAllan Stephens { 45863e7f1acSAllan Stephens bclink_update_last_sent(node, seqno); 45963e7f1acSAllan Stephens node->bclink.last_in = seqno; 46063e7f1acSAllan Stephens node->bclink.oos_state = 0; 46163e7f1acSAllan Stephens bcl->stats.recv_info++; 46263e7f1acSAllan Stephens 46363e7f1acSAllan Stephens /* 46463e7f1acSAllan Stephens * Unicast an ACK periodically, ensuring that 46563e7f1acSAllan Stephens * all nodes in the cluster don't ACK at the same time 46663e7f1acSAllan Stephens */ 46763e7f1acSAllan Stephens if (((seqno - tipc_own_addr) % TIPC_MIN_LINK_WIN) == 0) { 468247f0f3cSYing Xue tipc_link_proto_xmit(node->active_links[node->addr & 1], 46963e7f1acSAllan Stephens STATE_MSG, 0, 0, 0, 0, 0); 47063e7f1acSAllan Stephens bcl->stats.sent_acks++; 47163e7f1acSAllan Stephens } 47263e7f1acSAllan Stephens } 47363e7f1acSAllan Stephens 4742c53040fSBen Hutchings /** 475247f0f3cSYing Xue * tipc_bclink_rcv - receive a broadcast packet, and deliver upwards 476b97bf3fdSPer Liden * 4777216cd94SYing Xue * RCU is locked, no other locks set 478b97bf3fdSPer Liden */ 479247f0f3cSYing Xue void tipc_bclink_rcv(struct sk_buff *buf) 480b97bf3fdSPer Liden { 481b97bf3fdSPer Liden struct tipc_msg *msg = buf_msg(buf); 4825d3c488dSAllan Stephens struct tipc_node *node; 483b97bf3fdSPer Liden u32 next_in; 484b97bf3fdSPer Liden u32 seqno; 4850abd8ff2SJon Paul Maloy int deferred = 0; 486b97bf3fdSPer Liden 4875d3c488dSAllan Stephens /* Screen out unwanted broadcast messages */ 4885d3c488dSAllan Stephens if (msg_mc_netid(msg) != tipc_net_id) 4895d3c488dSAllan Stephens goto exit; 4905d3c488dSAllan Stephens 4915d3c488dSAllan Stephens node = tipc_node_find(msg_prevnode(msg)); 4925d3c488dSAllan Stephens if (unlikely(!node)) 4935d3c488dSAllan Stephens goto exit; 4945d3c488dSAllan Stephens 4955d3c488dSAllan Stephens tipc_node_lock(node); 496389dd9bcSYing Xue if (unlikely(!node->bclink.recv_permitted)) 4975d3c488dSAllan Stephens goto unlock; 498b97bf3fdSPer Liden 4998a275a6aSAllan Stephens /* Handle broadcast protocol message */ 500b97bf3fdSPer Liden if (unlikely(msg_user(msg) == BCAST_PROTOCOL)) { 5019f6bdcd4SAllan Stephens if (msg_type(msg) != STATE_MSG) 5029f6bdcd4SAllan Stephens goto unlock; 503b97bf3fdSPer Liden if (msg_destnode(msg) == tipc_own_addr) { 5044323add6SPer Liden tipc_bclink_acknowledge(node, msg_bcast_ack(msg)); 5054323add6SPer Liden tipc_node_unlock(node); 506d69afc90SYing Xue tipc_bclink_lock(); 507b97bf3fdSPer Liden bcl->stats.recv_nacks++; 50801d83eddSAllan Stephens bclink->retransmit_to = node; 509b97bf3fdSPer Liden bclink_retransmit_pkt(msg_bcgap_after(msg), 510b97bf3fdSPer Liden msg_bcgap_to(msg)); 511d69afc90SYing Xue tipc_bclink_unlock(); 512b97bf3fdSPer Liden } else { 5135d3c488dSAllan Stephens tipc_node_unlock(node); 5147a54d4a9SAllan Stephens bclink_peek_nack(msg); 515b97bf3fdSPer Liden } 5165d3c488dSAllan Stephens goto exit; 517b97bf3fdSPer Liden } 518b97bf3fdSPer Liden 5195d3c488dSAllan Stephens /* Handle in-sequence broadcast message */ 520b97bf3fdSPer Liden seqno = msg_seqno(msg); 5218a275a6aSAllan Stephens next_in = mod(node->bclink.last_in + 1); 522b97bf3fdSPer Liden 523b97bf3fdSPer Liden if (likely(seqno == next_in)) { 5248a275a6aSAllan Stephens receive: 5257a54d4a9SAllan Stephens /* Deliver message to destination */ 526b97bf3fdSPer Liden if (likely(msg_isdata(msg))) { 527d69afc90SYing Xue tipc_bclink_lock(); 52863e7f1acSAllan Stephens bclink_accept_pkt(node, seqno); 529d69afc90SYing Xue tipc_bclink_unlock(); 5304323add6SPer Liden tipc_node_unlock(node); 5319f6bdcd4SAllan Stephens if (likely(msg_mcast(msg))) 5320abd8ff2SJon Paul Maloy tipc_sk_mcast_rcv(buf); 5339f6bdcd4SAllan Stephens else 5345f6d9123SAllan Stephens kfree_skb(buf); 535b97bf3fdSPer Liden } else if (msg_user(msg) == MSG_BUNDLER) { 536d69afc90SYing Xue tipc_bclink_lock(); 53763e7f1acSAllan Stephens bclink_accept_pkt(node, seqno); 538b97bf3fdSPer Liden bcl->stats.recv_bundles++; 539b97bf3fdSPer Liden bcl->stats.recv_bundled += msg_msgcnt(msg); 540d69afc90SYing Xue tipc_bclink_unlock(); 5414323add6SPer Liden tipc_node_unlock(node); 542247f0f3cSYing Xue tipc_link_bundle_rcv(buf); 543b97bf3fdSPer Liden } else if (msg_user(msg) == MSG_FRAGMENTER) { 54437e22164SJon Paul Maloy tipc_buf_append(&node->bclink.reasm_buf, &buf); 54537e22164SJon Paul Maloy if (unlikely(!buf && !node->bclink.reasm_buf)) 54663e7f1acSAllan Stephens goto unlock; 547d69afc90SYing Xue tipc_bclink_lock(); 54863e7f1acSAllan Stephens bclink_accept_pkt(node, seqno); 549b97bf3fdSPer Liden bcl->stats.recv_fragments++; 55037e22164SJon Paul Maloy if (buf) { 551b97bf3fdSPer Liden bcl->stats.recv_fragmented++; 55240ba3cdfSErik Hugne msg = buf_msg(buf); 553d69afc90SYing Xue tipc_bclink_unlock(); 554528f6f4bSErik Hugne goto receive; 555528f6f4bSErik Hugne } 556d69afc90SYing Xue tipc_bclink_unlock(); 5574323add6SPer Liden tipc_node_unlock(node); 5589f6bdcd4SAllan Stephens } else if (msg_user(msg) == NAME_DISTRIBUTOR) { 559d69afc90SYing Xue tipc_bclink_lock(); 56063e7f1acSAllan Stephens bclink_accept_pkt(node, seqno); 561d69afc90SYing Xue tipc_bclink_unlock(); 5629f6bdcd4SAllan Stephens tipc_node_unlock(node); 563247f0f3cSYing Xue tipc_named_rcv(buf); 564b97bf3fdSPer Liden } else { 565d69afc90SYing Xue tipc_bclink_lock(); 56663e7f1acSAllan Stephens bclink_accept_pkt(node, seqno); 567d69afc90SYing Xue tipc_bclink_unlock(); 5684323add6SPer Liden tipc_node_unlock(node); 5695f6d9123SAllan Stephens kfree_skb(buf); 570b97bf3fdSPer Liden } 5715d3c488dSAllan Stephens buf = NULL; 5728a275a6aSAllan Stephens 5738a275a6aSAllan Stephens /* Determine new synchronization state */ 5744323add6SPer Liden tipc_node_lock(node); 5758a275a6aSAllan Stephens if (unlikely(!tipc_node_is_up(node))) 5768a275a6aSAllan Stephens goto unlock; 5778a275a6aSAllan Stephens 5787a54d4a9SAllan Stephens if (node->bclink.last_in == node->bclink.last_sent) 5798a275a6aSAllan Stephens goto unlock; 5808a275a6aSAllan Stephens 581bc6fecd4SYing Xue if (skb_queue_empty(&node->bclink.deferred_queue)) { 5827a54d4a9SAllan Stephens node->bclink.oos_state = 1; 5837a54d4a9SAllan Stephens goto unlock; 5847a54d4a9SAllan Stephens } 5857a54d4a9SAllan Stephens 586bc6fecd4SYing Xue msg = buf_msg(skb_peek(&node->bclink.deferred_queue)); 5878a275a6aSAllan Stephens seqno = msg_seqno(msg); 5888a275a6aSAllan Stephens next_in = mod(next_in + 1); 5898a275a6aSAllan Stephens if (seqno != next_in) 5908a275a6aSAllan Stephens goto unlock; 5918a275a6aSAllan Stephens 5928a275a6aSAllan Stephens /* Take in-sequence message from deferred queue & deliver it */ 593bc6fecd4SYing Xue buf = __skb_dequeue(&node->bclink.deferred_queue); 594b97bf3fdSPer Liden goto receive; 595b97bf3fdSPer Liden } 5968a275a6aSAllan Stephens 5978a275a6aSAllan Stephens /* Handle out-of-sequence broadcast message */ 5988a275a6aSAllan Stephens if (less(next_in, seqno)) { 599bc6fecd4SYing Xue deferred = tipc_link_defer_pkt(&node->bclink.deferred_queue, 6008a275a6aSAllan Stephens buf); 6017a54d4a9SAllan Stephens bclink_update_last_sent(node, seqno); 6025d3c488dSAllan Stephens buf = NULL; 6030abd8ff2SJon Paul Maloy } 6048a275a6aSAllan Stephens 605d69afc90SYing Xue tipc_bclink_lock(); 606b98158e3SAllan Stephens 6078a275a6aSAllan Stephens if (deferred) 6088a275a6aSAllan Stephens bcl->stats.deferred_recv++; 6090232c5a5SAllan Stephens else 6100232c5a5SAllan Stephens bcl->stats.duplicates++; 6118a275a6aSAllan Stephens 612d69afc90SYing Xue tipc_bclink_unlock(); 613b98158e3SAllan Stephens 6145d3c488dSAllan Stephens unlock: 6154323add6SPer Liden tipc_node_unlock(node); 6165d3c488dSAllan Stephens exit: 6175f6d9123SAllan Stephens kfree_skb(buf); 618b97bf3fdSPer Liden } 619b97bf3fdSPer Liden 6206c00055aSDavid S. Miller u32 tipc_bclink_acks_missing(struct tipc_node *n_ptr) 621b97bf3fdSPer Liden { 622389dd9bcSYing Xue return (n_ptr->bclink.recv_permitted && 6234323add6SPer Liden (tipc_bclink_get_last_sent() != n_ptr->bclink.acked)); 624b97bf3fdSPer Liden } 625b97bf3fdSPer Liden 626b97bf3fdSPer Liden 627b97bf3fdSPer Liden /** 6284323add6SPer Liden * tipc_bcbearer_send - send a packet through the broadcast pseudo-bearer 629b97bf3fdSPer Liden * 6302ff9f924SAllan Stephens * Send packet over as many bearers as necessary to reach all nodes 6312ff9f924SAllan Stephens * that have joined the broadcast link. 632b97bf3fdSPer Liden * 6332ff9f924SAllan Stephens * Returns 0 (packet sent successfully) under all circumstances, 6342ff9f924SAllan Stephens * since the broadcast link's pseudo-bearer never blocks 635b97bf3fdSPer Liden */ 636ae8509c4SPaul Gortmaker static int tipc_bcbearer_send(struct sk_buff *buf, struct tipc_bearer *unused1, 637b97bf3fdSPer Liden struct tipc_media_addr *unused2) 638b97bf3fdSPer Liden { 639b97bf3fdSPer Liden int bp_index; 6406f92ee54SJon Paul Maloy struct tipc_msg *msg = buf_msg(buf); 641b97bf3fdSPer Liden 642e6160710SGerlando Falauto /* Prepare broadcast link message for reliable transmission, 6432ff9f924SAllan Stephens * if first time trying to send it; 6442ff9f924SAllan Stephens * preparation is skipped for broadcast link protocol messages 6452ff9f924SAllan Stephens * since they are sent in an unreliable manner and don't need it 6462ff9f924SAllan Stephens */ 647b97bf3fdSPer Liden if (likely(!msg_non_seq(buf_msg(buf)))) { 648cd3decdfSAllan Stephens bcbuf_set_acks(buf, bclink->bcast_nodes.count); 64940aecb1bSAllan Stephens msg_set_non_seq(msg, 1); 650b97bf3fdSPer Liden msg_set_mc_netid(msg, tipc_net_id); 6510048b826SAllan Stephens bcl->stats.sent_info++; 6525e726900SAllan Stephens 653cd3decdfSAllan Stephens if (WARN_ON(!bclink->bcast_nodes.count)) { 6545e726900SAllan Stephens dump_stack(); 6555e726900SAllan Stephens return 0; 6565e726900SAllan Stephens } 657b97bf3fdSPer Liden } 658b97bf3fdSPer Liden 659b97bf3fdSPer Liden /* Send buffer over bearers until all targets reached */ 660cd3decdfSAllan Stephens bcbearer->remains = bclink->bcast_nodes; 661b97bf3fdSPer Liden 662b97bf3fdSPer Liden for (bp_index = 0; bp_index < MAX_BEARERS; bp_index++) { 6632d627b92SAllan Stephens struct tipc_bearer *p = bcbearer->bpairs[bp_index].primary; 6642d627b92SAllan Stephens struct tipc_bearer *s = bcbearer->bpairs[bp_index].secondary; 6656f92ee54SJon Paul Maloy struct tipc_bearer *bp[2] = {p, s}; 6666f92ee54SJon Paul Maloy struct tipc_bearer *b = bp[msg_link_selector(msg)]; 667488fc9afSGerlando Falauto struct sk_buff *tbuf; 668b97bf3fdSPer Liden 669b97bf3fdSPer Liden if (!p) 670e6160710SGerlando Falauto break; /* No more bearers to try */ 6716f92ee54SJon Paul Maloy if (!b) 6726f92ee54SJon Paul Maloy b = p; 67377861d9cSGerlando Falauto tipc_nmap_diff(&bcbearer->remains, &b->nodes, 674e6160710SGerlando Falauto &bcbearer->remains_new); 67565f51ef0SAllan Stephens if (bcbearer->remains_new.count == bcbearer->remains.count) 676e6160710SGerlando Falauto continue; /* Nothing added by bearer pair */ 677b97bf3fdSPer Liden 678488fc9afSGerlando Falauto if (bp_index == 0) { 679488fc9afSGerlando Falauto /* Use original buffer for first bearer */ 6807a2f7d18SYing Xue tipc_bearer_send(b->identity, buf, &b->bcast_addr); 681488fc9afSGerlando Falauto } else { 682488fc9afSGerlando Falauto /* Avoid concurrent buffer access */ 683bad93e9dSOctavian Purdila tbuf = pskb_copy_for_clone(buf, GFP_ATOMIC); 684488fc9afSGerlando Falauto if (!tbuf) 685488fc9afSGerlando Falauto break; 6867a2f7d18SYing Xue tipc_bearer_send(b->identity, tbuf, &b->bcast_addr); 687488fc9afSGerlando Falauto kfree_skb(tbuf); /* Bearer keeps a clone */ 688488fc9afSGerlando Falauto } 68965f51ef0SAllan Stephens if (bcbearer->remains_new.count == 0) 690e6160710SGerlando Falauto break; /* All targets reached */ 691b97bf3fdSPer Liden 69265f51ef0SAllan Stephens bcbearer->remains = bcbearer->remains_new; 693b97bf3fdSPer Liden } 694b97bf3fdSPer Liden 6952ff9f924SAllan Stephens return 0; 696b97bf3fdSPer Liden } 697b97bf3fdSPer Liden 698b97bf3fdSPer Liden /** 6994323add6SPer Liden * tipc_bcbearer_sort - create sets of bearer pairs used by broadcast bearer 700b97bf3fdSPer Liden */ 70128dd9418SYing Xue void tipc_bcbearer_sort(struct tipc_node_map *nm_ptr, u32 node, bool action) 702b97bf3fdSPer Liden { 7037f9ab6acSPaul Gortmaker struct tipc_bcbearer_pair *bp_temp = bcbearer->bpairs_temp; 7047f9ab6acSPaul Gortmaker struct tipc_bcbearer_pair *bp_curr; 705f8322dfcSYing Xue struct tipc_bearer *b; 706b97bf3fdSPer Liden int b_index; 707b97bf3fdSPer Liden int pri; 708b97bf3fdSPer Liden 709d69afc90SYing Xue tipc_bclink_lock(); 710b97bf3fdSPer Liden 71128dd9418SYing Xue if (action) 71228dd9418SYing Xue tipc_nmap_add(nm_ptr, node); 71328dd9418SYing Xue else 71428dd9418SYing Xue tipc_nmap_remove(nm_ptr, node); 71528dd9418SYing Xue 716b97bf3fdSPer Liden /* Group bearers by priority (can assume max of two per priority) */ 717b97bf3fdSPer Liden memset(bp_temp, 0, sizeof(bcbearer->bpairs_temp)); 718b97bf3fdSPer Liden 719f8322dfcSYing Xue rcu_read_lock(); 720b97bf3fdSPer Liden for (b_index = 0; b_index < MAX_BEARERS; b_index++) { 721f8322dfcSYing Xue b = rcu_dereference_rtnl(bearer_list[b_index]); 722f47de12bSYing Xue if (!b || !b->nodes.count) 723b97bf3fdSPer Liden continue; 724b97bf3fdSPer Liden 725b97bf3fdSPer Liden if (!bp_temp[b->priority].primary) 726b97bf3fdSPer Liden bp_temp[b->priority].primary = b; 727b97bf3fdSPer Liden else 728b97bf3fdSPer Liden bp_temp[b->priority].secondary = b; 729b97bf3fdSPer Liden } 730f8322dfcSYing Xue rcu_read_unlock(); 731b97bf3fdSPer Liden 732b97bf3fdSPer Liden /* Create array of bearer pairs for broadcasting */ 733b97bf3fdSPer Liden bp_curr = bcbearer->bpairs; 734b97bf3fdSPer Liden memset(bcbearer->bpairs, 0, sizeof(bcbearer->bpairs)); 735b97bf3fdSPer Liden 73616cb4b33SPer Liden for (pri = TIPC_MAX_LINK_PRI; pri >= 0; pri--) { 737b97bf3fdSPer Liden 738b97bf3fdSPer Liden if (!bp_temp[pri].primary) 739b97bf3fdSPer Liden continue; 740b97bf3fdSPer Liden 741b97bf3fdSPer Liden bp_curr->primary = bp_temp[pri].primary; 742b97bf3fdSPer Liden 743b97bf3fdSPer Liden if (bp_temp[pri].secondary) { 7444323add6SPer Liden if (tipc_nmap_equal(&bp_temp[pri].primary->nodes, 745b97bf3fdSPer Liden &bp_temp[pri].secondary->nodes)) { 746b97bf3fdSPer Liden bp_curr->secondary = bp_temp[pri].secondary; 747b97bf3fdSPer Liden } else { 748b97bf3fdSPer Liden bp_curr++; 749b97bf3fdSPer Liden bp_curr->primary = bp_temp[pri].secondary; 750b97bf3fdSPer Liden } 751b97bf3fdSPer Liden } 752b97bf3fdSPer Liden 753b97bf3fdSPer Liden bp_curr++; 754b97bf3fdSPer Liden } 755b97bf3fdSPer Liden 756d69afc90SYing Xue tipc_bclink_unlock(); 757b97bf3fdSPer Liden } 758b97bf3fdSPer Liden 759d8182804SRichard Alpe static int __tipc_nl_add_bc_link_stat(struct sk_buff *skb, 760d8182804SRichard Alpe struct tipc_stats *stats) 7617be57fc6SRichard Alpe { 7627be57fc6SRichard Alpe int i; 7637be57fc6SRichard Alpe struct nlattr *nest; 7647be57fc6SRichard Alpe 7657be57fc6SRichard Alpe struct nla_map { 7667be57fc6SRichard Alpe __u32 key; 7677be57fc6SRichard Alpe __u32 val; 7687be57fc6SRichard Alpe }; 7697be57fc6SRichard Alpe 7707be57fc6SRichard Alpe struct nla_map map[] = { 7717be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_INFO, stats->recv_info}, 7727be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_FRAGMENTS, stats->recv_fragments}, 7737be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_FRAGMENTED, stats->recv_fragmented}, 7747be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_BUNDLES, stats->recv_bundles}, 7757be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_BUNDLED, stats->recv_bundled}, 7767be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_INFO, stats->sent_info}, 7777be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_FRAGMENTS, stats->sent_fragments}, 7787be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_FRAGMENTED, stats->sent_fragmented}, 7797be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_BUNDLES, stats->sent_bundles}, 7807be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_BUNDLED, stats->sent_bundled}, 7817be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_NACKS, stats->recv_nacks}, 7827be57fc6SRichard Alpe {TIPC_NLA_STATS_RX_DEFERRED, stats->deferred_recv}, 7837be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_NACKS, stats->sent_nacks}, 7847be57fc6SRichard Alpe {TIPC_NLA_STATS_TX_ACKS, stats->sent_acks}, 7857be57fc6SRichard Alpe {TIPC_NLA_STATS_RETRANSMITTED, stats->retransmitted}, 7867be57fc6SRichard Alpe {TIPC_NLA_STATS_DUPLICATES, stats->duplicates}, 7877be57fc6SRichard Alpe {TIPC_NLA_STATS_LINK_CONGS, stats->link_congs}, 7887be57fc6SRichard Alpe {TIPC_NLA_STATS_MAX_QUEUE, stats->max_queue_sz}, 7897be57fc6SRichard Alpe {TIPC_NLA_STATS_AVG_QUEUE, stats->queue_sz_counts ? 7907be57fc6SRichard Alpe (stats->accu_queue_sz / stats->queue_sz_counts) : 0} 7917be57fc6SRichard Alpe }; 7927be57fc6SRichard Alpe 7937be57fc6SRichard Alpe nest = nla_nest_start(skb, TIPC_NLA_LINK_STATS); 7947be57fc6SRichard Alpe if (!nest) 7957be57fc6SRichard Alpe return -EMSGSIZE; 7967be57fc6SRichard Alpe 7977be57fc6SRichard Alpe for (i = 0; i < ARRAY_SIZE(map); i++) 7987be57fc6SRichard Alpe if (nla_put_u32(skb, map[i].key, map[i].val)) 7997be57fc6SRichard Alpe goto msg_full; 8007be57fc6SRichard Alpe 8017be57fc6SRichard Alpe nla_nest_end(skb, nest); 8027be57fc6SRichard Alpe 8037be57fc6SRichard Alpe return 0; 8047be57fc6SRichard Alpe msg_full: 8057be57fc6SRichard Alpe nla_nest_cancel(skb, nest); 8067be57fc6SRichard Alpe 8077be57fc6SRichard Alpe return -EMSGSIZE; 8087be57fc6SRichard Alpe } 8097be57fc6SRichard Alpe 8107be57fc6SRichard Alpe int tipc_nl_add_bc_link(struct tipc_nl_msg *msg) 8117be57fc6SRichard Alpe { 8127be57fc6SRichard Alpe int err; 8137be57fc6SRichard Alpe void *hdr; 8147be57fc6SRichard Alpe struct nlattr *attrs; 8157be57fc6SRichard Alpe struct nlattr *prop; 8167be57fc6SRichard Alpe 8177be57fc6SRichard Alpe if (!bcl) 8187be57fc6SRichard Alpe return 0; 8197be57fc6SRichard Alpe 8207be57fc6SRichard Alpe tipc_bclink_lock(); 8217be57fc6SRichard Alpe 8227be57fc6SRichard Alpe hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_v2_family, 8237be57fc6SRichard Alpe NLM_F_MULTI, TIPC_NL_LINK_GET); 8247be57fc6SRichard Alpe if (!hdr) 8257be57fc6SRichard Alpe return -EMSGSIZE; 8267be57fc6SRichard Alpe 8277be57fc6SRichard Alpe attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK); 8287be57fc6SRichard Alpe if (!attrs) 8297be57fc6SRichard Alpe goto msg_full; 8307be57fc6SRichard Alpe 8317be57fc6SRichard Alpe /* The broadcast link is always up */ 8327be57fc6SRichard Alpe if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP)) 8337be57fc6SRichard Alpe goto attr_msg_full; 8347be57fc6SRichard Alpe 8357be57fc6SRichard Alpe if (nla_put_flag(msg->skb, TIPC_NLA_LINK_BROADCAST)) 8367be57fc6SRichard Alpe goto attr_msg_full; 8377be57fc6SRichard Alpe if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, bcl->name)) 8387be57fc6SRichard Alpe goto attr_msg_full; 8397be57fc6SRichard Alpe if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, bcl->next_in_no)) 8407be57fc6SRichard Alpe goto attr_msg_full; 8417be57fc6SRichard Alpe if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, bcl->next_out_no)) 8427be57fc6SRichard Alpe goto attr_msg_full; 8437be57fc6SRichard Alpe 8447be57fc6SRichard Alpe prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP); 8457be57fc6SRichard Alpe if (!prop) 8467be57fc6SRichard Alpe goto attr_msg_full; 8477be57fc6SRichard Alpe if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN, bcl->queue_limit[0])) 8487be57fc6SRichard Alpe goto prop_msg_full; 8497be57fc6SRichard Alpe nla_nest_end(msg->skb, prop); 8507be57fc6SRichard Alpe 8517be57fc6SRichard Alpe err = __tipc_nl_add_bc_link_stat(msg->skb, &bcl->stats); 8527be57fc6SRichard Alpe if (err) 8537be57fc6SRichard Alpe goto attr_msg_full; 8547be57fc6SRichard Alpe 8557be57fc6SRichard Alpe tipc_bclink_unlock(); 8567be57fc6SRichard Alpe nla_nest_end(msg->skb, attrs); 8577be57fc6SRichard Alpe genlmsg_end(msg->skb, hdr); 8587be57fc6SRichard Alpe 8597be57fc6SRichard Alpe return 0; 8607be57fc6SRichard Alpe 8617be57fc6SRichard Alpe prop_msg_full: 8627be57fc6SRichard Alpe nla_nest_cancel(msg->skb, prop); 8637be57fc6SRichard Alpe attr_msg_full: 8647be57fc6SRichard Alpe nla_nest_cancel(msg->skb, attrs); 8657be57fc6SRichard Alpe msg_full: 8667be57fc6SRichard Alpe tipc_bclink_unlock(); 8677be57fc6SRichard Alpe genlmsg_cancel(msg->skb, hdr); 8687be57fc6SRichard Alpe 8697be57fc6SRichard Alpe return -EMSGSIZE; 8707be57fc6SRichard Alpe } 871b97bf3fdSPer Liden 8724323add6SPer Liden int tipc_bclink_stats(char *buf, const u32 buf_size) 873b97bf3fdSPer Liden { 874dc1aed37SErik Hugne int ret; 875dc1aed37SErik Hugne struct tipc_stats *s; 876b97bf3fdSPer Liden 877b97bf3fdSPer Liden if (!bcl) 878b97bf3fdSPer Liden return 0; 879b97bf3fdSPer Liden 880d69afc90SYing Xue tipc_bclink_lock(); 881b97bf3fdSPer Liden 882dc1aed37SErik Hugne s = &bcl->stats; 883dc1aed37SErik Hugne 884dc1aed37SErik Hugne ret = tipc_snprintf(buf, buf_size, "Link <%s>\n" 885b97bf3fdSPer Liden " Window:%u packets\n", 886b97bf3fdSPer Liden bcl->name, bcl->queue_limit[0]); 887dc1aed37SErik Hugne ret += tipc_snprintf(buf + ret, buf_size - ret, 888dc1aed37SErik Hugne " RX packets:%u fragments:%u/%u bundles:%u/%u\n", 889dc1aed37SErik Hugne s->recv_info, s->recv_fragments, 890dc1aed37SErik Hugne s->recv_fragmented, s->recv_bundles, 891dc1aed37SErik Hugne s->recv_bundled); 892dc1aed37SErik Hugne ret += tipc_snprintf(buf + ret, buf_size - ret, 893dc1aed37SErik Hugne " TX packets:%u fragments:%u/%u bundles:%u/%u\n", 894dc1aed37SErik Hugne s->sent_info, s->sent_fragments, 895dc1aed37SErik Hugne s->sent_fragmented, s->sent_bundles, 896dc1aed37SErik Hugne s->sent_bundled); 897dc1aed37SErik Hugne ret += tipc_snprintf(buf + ret, buf_size - ret, 898dc1aed37SErik Hugne " RX naks:%u defs:%u dups:%u\n", 899dc1aed37SErik Hugne s->recv_nacks, s->deferred_recv, s->duplicates); 900dc1aed37SErik Hugne ret += tipc_snprintf(buf + ret, buf_size - ret, 901dc1aed37SErik Hugne " TX naks:%u acks:%u dups:%u\n", 902dc1aed37SErik Hugne s->sent_nacks, s->sent_acks, s->retransmitted); 903dc1aed37SErik Hugne ret += tipc_snprintf(buf + ret, buf_size - ret, 9043c294cb3SYing Xue " Congestion link:%u Send queue max:%u avg:%u\n", 9053c294cb3SYing Xue s->link_congs, s->max_queue_sz, 906dc1aed37SErik Hugne s->queue_sz_counts ? 907dc1aed37SErik Hugne (s->accu_queue_sz / s->queue_sz_counts) : 0); 908b97bf3fdSPer Liden 909d69afc90SYing Xue tipc_bclink_unlock(); 910dc1aed37SErik Hugne return ret; 911b97bf3fdSPer Liden } 912b97bf3fdSPer Liden 9134323add6SPer Liden int tipc_bclink_reset_stats(void) 914b97bf3fdSPer Liden { 915b97bf3fdSPer Liden if (!bcl) 916b97bf3fdSPer Liden return -ENOPROTOOPT; 917b97bf3fdSPer Liden 918d69afc90SYing Xue tipc_bclink_lock(); 919b97bf3fdSPer Liden memset(&bcl->stats, 0, sizeof(bcl->stats)); 920d69afc90SYing Xue tipc_bclink_unlock(); 9210e35fd5eSAllan Stephens return 0; 922b97bf3fdSPer Liden } 923b97bf3fdSPer Liden 9244323add6SPer Liden int tipc_bclink_set_queue_limits(u32 limit) 925b97bf3fdSPer Liden { 926b97bf3fdSPer Liden if (!bcl) 927b97bf3fdSPer Liden return -ENOPROTOOPT; 928b97bf3fdSPer Liden if ((limit < TIPC_MIN_LINK_WIN) || (limit > TIPC_MAX_LINK_WIN)) 929b97bf3fdSPer Liden return -EINVAL; 930b97bf3fdSPer Liden 931d69afc90SYing Xue tipc_bclink_lock(); 9324323add6SPer Liden tipc_link_set_queue_limits(bcl, limit); 933d69afc90SYing Xue tipc_bclink_unlock(); 9340e35fd5eSAllan Stephens return 0; 935b97bf3fdSPer Liden } 936b97bf3fdSPer Liden 937eb8b00f5SYing Xue int tipc_bclink_init(void) 938b97bf3fdSPer Liden { 939eb8b00f5SYing Xue bcbearer = kzalloc(sizeof(*bcbearer), GFP_ATOMIC); 940eb8b00f5SYing Xue if (!bcbearer) 941eb8b00f5SYing Xue return -ENOMEM; 942eb8b00f5SYing Xue 943eb8b00f5SYing Xue bclink = kzalloc(sizeof(*bclink), GFP_ATOMIC); 944eb8b00f5SYing Xue if (!bclink) { 945eb8b00f5SYing Xue kfree(bcbearer); 946eb8b00f5SYing Xue return -ENOMEM; 947eb8b00f5SYing Xue } 948eb8b00f5SYing Xue 949eb8b00f5SYing Xue bcl = &bclink->link; 950b97bf3fdSPer Liden bcbearer->bearer.media = &bcbearer->media; 9514323add6SPer Liden bcbearer->media.send_msg = tipc_bcbearer_send; 9522e2d9be8SAllan Stephens sprintf(bcbearer->media.name, "tipc-broadcast"); 953b97bf3fdSPer Liden 954d69afc90SYing Xue spin_lock_init(&bclink->lock); 95558dc55f2SYing Xue __skb_queue_head_init(&bcl->outqueue); 956bc6fecd4SYing Xue __skb_queue_head_init(&bcl->deferred_queue); 9574988bb4aSErik Hugne skb_queue_head_init(&bcl->waiting_sks); 958b97bf3fdSPer Liden bcl->next_out_no = 1; 95934af946aSIngo Molnar spin_lock_init(&bclink->node.lock); 96050100a5eSJon Paul Maloy __skb_queue_head_init(&bclink->node.waiting_sks); 961b97bf3fdSPer Liden bcl->owner = &bclink->node; 962b97bf3fdSPer Liden bcl->max_pkt = MAX_PKT_DEFAULT_MCAST; 9634323add6SPer Liden tipc_link_set_queue_limits(bcl, BCLINK_WIN_DEFAULT); 9647a2f7d18SYing Xue bcl->bearer_id = MAX_BEARERS; 965f8322dfcSYing Xue rcu_assign_pointer(bearer_list[MAX_BEARERS], &bcbearer->bearer); 966b97bf3fdSPer Liden bcl->state = WORKING_WORKING; 9674b704d59SStephen Hemminger strlcpy(bcl->name, tipc_bclink_name, TIPC_MAX_LINK_NAME); 968eb8b00f5SYing Xue return 0; 969b97bf3fdSPer Liden } 970b97bf3fdSPer Liden 9714323add6SPer Liden void tipc_bclink_stop(void) 972b97bf3fdSPer Liden { 973d69afc90SYing Xue tipc_bclink_lock(); 974581465faSJon Paul Maloy tipc_link_purge_queues(bcl); 975d69afc90SYing Xue tipc_bclink_unlock(); 976c47e9b91SAllan Stephens 977f8322dfcSYing Xue RCU_INIT_POINTER(bearer_list[BCBEARER], NULL); 978eb8b00f5SYing Xue synchronize_net(); 979eb8b00f5SYing Xue kfree(bcbearer); 980eb8b00f5SYing Xue kfree(bclink); 981b97bf3fdSPer Liden } 982b97bf3fdSPer Liden 9833e22e62bSAllan Stephens /** 9843e22e62bSAllan Stephens * tipc_nmap_add - add a node to a node map 9853e22e62bSAllan Stephens */ 98628dd9418SYing Xue static void tipc_nmap_add(struct tipc_node_map *nm_ptr, u32 node) 9873e22e62bSAllan Stephens { 9883e22e62bSAllan Stephens int n = tipc_node(node); 9893e22e62bSAllan Stephens int w = n / WSIZE; 9903e22e62bSAllan Stephens u32 mask = (1 << (n % WSIZE)); 9913e22e62bSAllan Stephens 9923e22e62bSAllan Stephens if ((nm_ptr->map[w] & mask) == 0) { 9933e22e62bSAllan Stephens nm_ptr->count++; 9943e22e62bSAllan Stephens nm_ptr->map[w] |= mask; 9953e22e62bSAllan Stephens } 9963e22e62bSAllan Stephens } 9973e22e62bSAllan Stephens 9983e22e62bSAllan Stephens /** 9993e22e62bSAllan Stephens * tipc_nmap_remove - remove a node from a node map 10003e22e62bSAllan Stephens */ 100128dd9418SYing Xue static void tipc_nmap_remove(struct tipc_node_map *nm_ptr, u32 node) 10023e22e62bSAllan Stephens { 10033e22e62bSAllan Stephens int n = tipc_node(node); 10043e22e62bSAllan Stephens int w = n / WSIZE; 10053e22e62bSAllan Stephens u32 mask = (1 << (n % WSIZE)); 10063e22e62bSAllan Stephens 10073e22e62bSAllan Stephens if ((nm_ptr->map[w] & mask) != 0) { 10083e22e62bSAllan Stephens nm_ptr->map[w] &= ~mask; 10093e22e62bSAllan Stephens nm_ptr->count--; 10103e22e62bSAllan Stephens } 10113e22e62bSAllan Stephens } 10123e22e62bSAllan Stephens 10133e22e62bSAllan Stephens /** 10143e22e62bSAllan Stephens * tipc_nmap_diff - find differences between node maps 10153e22e62bSAllan Stephens * @nm_a: input node map A 10163e22e62bSAllan Stephens * @nm_b: input node map B 10173e22e62bSAllan Stephens * @nm_diff: output node map A-B (i.e. nodes of A that are not in B) 10183e22e62bSAllan Stephens */ 101931e3c3f6Sstephen hemminger static void tipc_nmap_diff(struct tipc_node_map *nm_a, 102031e3c3f6Sstephen hemminger struct tipc_node_map *nm_b, 10213e22e62bSAllan Stephens struct tipc_node_map *nm_diff) 10223e22e62bSAllan Stephens { 10233e22e62bSAllan Stephens int stop = ARRAY_SIZE(nm_a->map); 10243e22e62bSAllan Stephens int w; 10253e22e62bSAllan Stephens int b; 10263e22e62bSAllan Stephens u32 map; 10273e22e62bSAllan Stephens 10283e22e62bSAllan Stephens memset(nm_diff, 0, sizeof(*nm_diff)); 10293e22e62bSAllan Stephens for (w = 0; w < stop; w++) { 10303e22e62bSAllan Stephens map = nm_a->map[w] ^ (nm_a->map[w] & nm_b->map[w]); 10313e22e62bSAllan Stephens nm_diff->map[w] = map; 10323e22e62bSAllan Stephens if (map != 0) { 10333e22e62bSAllan Stephens for (b = 0 ; b < WSIZE; b++) { 10343e22e62bSAllan Stephens if (map & (1 << b)) 10353e22e62bSAllan Stephens nm_diff->count++; 10363e22e62bSAllan Stephens } 10373e22e62bSAllan Stephens } 10383e22e62bSAllan Stephens } 10393e22e62bSAllan Stephens } 104043608edcSAllan Stephens 104143608edcSAllan Stephens /** 104243608edcSAllan Stephens * tipc_port_list_add - add a port to a port list, ensuring no duplicates 104343608edcSAllan Stephens */ 10444584310bSPaul Gortmaker void tipc_port_list_add(struct tipc_port_list *pl_ptr, u32 port) 104543608edcSAllan Stephens { 10464584310bSPaul Gortmaker struct tipc_port_list *item = pl_ptr; 104743608edcSAllan Stephens int i; 104843608edcSAllan Stephens int item_sz = PLSIZE; 104943608edcSAllan Stephens int cnt = pl_ptr->count; 105043608edcSAllan Stephens 105143608edcSAllan Stephens for (; ; cnt -= item_sz, item = item->next) { 105243608edcSAllan Stephens if (cnt < PLSIZE) 105343608edcSAllan Stephens item_sz = cnt; 105443608edcSAllan Stephens for (i = 0; i < item_sz; i++) 105543608edcSAllan Stephens if (item->ports[i] == port) 105643608edcSAllan Stephens return; 105743608edcSAllan Stephens if (i < PLSIZE) { 105843608edcSAllan Stephens item->ports[i] = port; 105943608edcSAllan Stephens pl_ptr->count++; 106043608edcSAllan Stephens return; 106143608edcSAllan Stephens } 106243608edcSAllan Stephens if (!item->next) { 106343608edcSAllan Stephens item->next = kmalloc(sizeof(*item), GFP_ATOMIC); 106443608edcSAllan Stephens if (!item->next) { 10652cf8aa19SErik Hugne pr_warn("Incomplete multicast delivery, no memory\n"); 106643608edcSAllan Stephens return; 106743608edcSAllan Stephens } 106843608edcSAllan Stephens item->next->next = NULL; 106943608edcSAllan Stephens } 107043608edcSAllan Stephens } 107143608edcSAllan Stephens } 107243608edcSAllan Stephens 107343608edcSAllan Stephens /** 107443608edcSAllan Stephens * tipc_port_list_free - free dynamically created entries in port_list chain 107543608edcSAllan Stephens * 107643608edcSAllan Stephens */ 10774584310bSPaul Gortmaker void tipc_port_list_free(struct tipc_port_list *pl_ptr) 107843608edcSAllan Stephens { 10794584310bSPaul Gortmaker struct tipc_port_list *item; 10804584310bSPaul Gortmaker struct tipc_port_list *next; 108143608edcSAllan Stephens 108243608edcSAllan Stephens for (item = pl_ptr->next; item; item = next) { 108343608edcSAllan Stephens next = item->next; 108443608edcSAllan Stephens kfree(item); 108543608edcSAllan Stephens } 108643608edcSAllan Stephens } 1087