| /* |
| * net/tipc/name_table.c: TIPC name table code |
| * |
| * Copyright (c) 2000-2006, 2014-2015, Ericsson AB |
| * Copyright (c) 2004-2008, 2010-2014, Wind River Systems |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are met: |
| * |
| * 1. Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * 2. Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * 3. Neither the names of the copyright holders nor the names of its |
| * contributors may be used to endorse or promote products derived from |
| * this software without specific prior written permission. |
| * |
| * Alternatively, this software may be distributed under the terms of the |
| * GNU General Public License ("GPL") version 2 as published by the Free |
| * Software Foundation. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| * POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| #include <net/sock.h> |
| #include "core.h" |
| #include "netlink.h" |
| #include "name_table.h" |
| #include "name_distr.h" |
| #include "subscr.h" |
| #include "bcast.h" |
| #include "addr.h" |
| #include "node.h" |
| #include "group.h" |
| #include <net/genetlink.h> |
| |
| #define TIPC_NAMETBL_SIZE 1024 /* must be a power of 2 */ |
| |
| /** |
| * struct name_info - name sequence publication info |
| * @node_list: circular list of publications made by own node |
| * @cluster_list: circular list of publications made by own cluster |
| * @zone_list: circular list of publications made by own zone |
| * @node_list_size: number of entries in "node_list" |
| * @cluster_list_size: number of entries in "cluster_list" |
| * @zone_list_size: number of entries in "zone_list" |
| * |
| * Note: The zone list always contains at least one entry, since all |
| * publications of the associated name sequence belong to it. |
| * (The cluster and node lists may be empty.) |
| */ |
| struct name_info { |
| struct list_head node_list; |
| struct list_head cluster_list; |
| struct list_head zone_list; |
| u32 node_list_size; |
| u32 cluster_list_size; |
| u32 zone_list_size; |
| }; |
| |
| /** |
| * struct sub_seq - container for all published instances of a name sequence |
| * @lower: name sequence lower bound |
| * @upper: name sequence upper bound |
| * @info: pointer to name sequence publication info |
| */ |
| struct sub_seq { |
| u32 lower; |
| u32 upper; |
| struct name_info *info; |
| }; |
| |
| /** |
| * struct name_seq - container for all published instances of a name type |
| * @type: 32 bit 'type' value for name sequence |
| * @sseq: pointer to dynamically-sized array of sub-sequences of this 'type'; |
| * sub-sequences are sorted in ascending order |
| * @alloc: number of sub-sequences currently in array |
| * @first_free: array index of first unused sub-sequence entry |
| * @ns_list: links to adjacent name sequences in hash chain |
| * @subscriptions: list of subscriptions for this 'type' |
| * @lock: spinlock controlling access to publication lists of all sub-sequences |
| * @rcu: RCU callback head used for deferred freeing |
| */ |
| struct name_seq { |
| u32 type; |
| struct sub_seq *sseqs; |
| u32 alloc; |
| u32 first_free; |
| struct hlist_node ns_list; |
| struct list_head subscriptions; |
| spinlock_t lock; |
| struct rcu_head rcu; |
| }; |
| |
| static int hash(int x) |
| { |
| return x & (TIPC_NAMETBL_SIZE - 1); |
| } |
| |
| /** |
| * publ_create - create a publication structure |
| */ |
| static struct publication *publ_create(u32 type, u32 lower, u32 upper, |
| u32 scope, u32 node, u32 port_ref, |
| u32 key) |
| { |
| struct publication *publ = kzalloc(sizeof(*publ), GFP_ATOMIC); |
| if (publ == NULL) { |
| pr_warn("Publication creation failure, no memory\n"); |
| return NULL; |
| } |
| |
| publ->type = type; |
| publ->lower = lower; |
| publ->upper = upper; |
| publ->scope = scope; |
| publ->node = node; |
| publ->ref = port_ref; |
| publ->key = key; |
| INIT_LIST_HEAD(&publ->pport_list); |
| return publ; |
| } |
| |
| /** |
| * tipc_subseq_alloc - allocate a specified number of sub-sequence structures |
| */ |
| static struct sub_seq *tipc_subseq_alloc(u32 cnt) |
| { |
| return kcalloc(cnt, sizeof(struct sub_seq), GFP_ATOMIC); |
| } |
| |
| /** |
| * tipc_nameseq_create - create a name sequence structure for the specified 'type' |
| * |
| * Allocates a single sub-sequence structure and sets it to all 0's. |
| */ |
| static struct name_seq *tipc_nameseq_create(u32 type, struct hlist_head *seq_head) |
| { |
| struct name_seq *nseq = kzalloc(sizeof(*nseq), GFP_ATOMIC); |
| struct sub_seq *sseq = tipc_subseq_alloc(1); |
| |
| if (!nseq || !sseq) { |
| pr_warn("Name sequence creation failed, no memory\n"); |
| kfree(nseq); |
| kfree(sseq); |
| return NULL; |
| } |
| |
| spin_lock_init(&nseq->lock); |
| nseq->type = type; |
| nseq->sseqs = sseq; |
| nseq->alloc = 1; |
| INIT_HLIST_NODE(&nseq->ns_list); |
| INIT_LIST_HEAD(&nseq->subscriptions); |
| hlist_add_head_rcu(&nseq->ns_list, seq_head); |
| return nseq; |
| } |
| |
| /** |
| * nameseq_find_subseq - find sub-sequence (if any) matching a name instance |
| * |
| * Very time-critical, so binary searches through sub-sequence array. |
| */ |
| static struct sub_seq *nameseq_find_subseq(struct name_seq *nseq, |
| u32 instance) |
| { |
| struct sub_seq *sseqs = nseq->sseqs; |
| int low = 0; |
| int high = nseq->first_free - 1; |
| int mid; |
| |
| while (low <= high) { |
| mid = (low + high) / 2; |
| if (instance < sseqs[mid].lower) |
| high = mid - 1; |
| else if (instance > sseqs[mid].upper) |
| low = mid + 1; |
| else |
| return &sseqs[mid]; |
| } |
| return NULL; |
| } |
| |
| /** |
| * nameseq_locate_subseq - determine position of name instance in sub-sequence |
| * |
| * Returns index in sub-sequence array of the entry that contains the specified |
| * instance value; if no entry contains that value, returns the position |
| * where a new entry for it would be inserted in the array. |
| * |
| * Note: Similar to binary search code for locating a sub-sequence. |
| */ |
| static u32 nameseq_locate_subseq(struct name_seq *nseq, u32 instance) |
| { |
| struct sub_seq *sseqs = nseq->sseqs; |
| int low = 0; |
| int high = nseq->first_free - 1; |
| int mid; |
| |
| while (low <= high) { |
| mid = (low + high) / 2; |
| if (instance < sseqs[mid].lower) |
| high = mid - 1; |
| else if (instance > sseqs[mid].upper) |
| low = mid + 1; |
| else |
| return mid; |
| } |
| return low; |
| } |
| |
| /** |
| * tipc_nameseq_insert_publ |
| */ |
| static struct publication *tipc_nameseq_insert_publ(struct net *net, |
| struct name_seq *nseq, |
| u32 type, u32 lower, |
| u32 upper, u32 scope, |
| u32 node, u32 port, u32 key) |
| { |
| struct tipc_subscription *s; |
| struct tipc_subscription *st; |
| struct publication *publ; |
| struct sub_seq *sseq; |
| struct name_info *info; |
| int created_subseq = 0; |
| |
| sseq = nameseq_find_subseq(nseq, lower); |
| if (sseq) { |
| |
| /* Lower end overlaps existing entry => need an exact match */ |
| if ((sseq->lower != lower) || (sseq->upper != upper)) { |
| return NULL; |
| } |
| |
| info = sseq->info; |
| |
| /* Check if an identical publication already exists */ |
| list_for_each_entry(publ, &info->zone_list, zone_list) { |
| if ((publ->ref == port) && (publ->key == key) && |
| (!publ->node || (publ->node == node))) |
| return NULL; |
| } |
| } else { |
| u32 inspos; |
| struct sub_seq *freesseq; |
| |
| /* Find where lower end should be inserted */ |
| inspos = nameseq_locate_subseq(nseq, lower); |
| |
| /* Fail if upper end overlaps into an existing entry */ |
| if ((inspos < nseq->first_free) && |
| (upper >= nseq->sseqs[inspos].lower)) { |
| return NULL; |
| } |
| |
| /* Ensure there is space for new sub-sequence */ |
| if (nseq->first_free == nseq->alloc) { |
| struct sub_seq *sseqs = tipc_subseq_alloc(nseq->alloc * 2); |
| |
| if (!sseqs) { |
| pr_warn("Cannot publish {%u,%u,%u}, no memory\n", |
| type, lower, upper); |
| return NULL; |
| } |
| memcpy(sseqs, nseq->sseqs, |
| nseq->alloc * sizeof(struct sub_seq)); |
| kfree(nseq->sseqs); |
| nseq->sseqs = sseqs; |
| nseq->alloc *= 2; |
| } |
| |
| info = kzalloc(sizeof(*info), GFP_ATOMIC); |
| if (!info) { |
| pr_warn("Cannot publish {%u,%u,%u}, no memory\n", |
| type, lower, upper); |
| return NULL; |
| } |
| |
| INIT_LIST_HEAD(&info->node_list); |
| INIT_LIST_HEAD(&info->cluster_list); |
| INIT_LIST_HEAD(&info->zone_list); |
| |
| /* Insert new sub-sequence */ |
| sseq = &nseq->sseqs[inspos]; |
| freesseq = &nseq->sseqs[nseq->first_free]; |
| memmove(sseq + 1, sseq, (freesseq - sseq) * sizeof(*sseq)); |
| memset(sseq, 0, sizeof(*sseq)); |
| nseq->first_free++; |
| sseq->lower = lower; |
| sseq->upper = upper; |
| sseq->info = info; |
| created_subseq = 1; |
| } |
| |
| /* Insert a publication */ |
| publ = publ_create(type, lower, upper, scope, node, port, key); |
| if (!publ) |
| return NULL; |
| |
| list_add(&publ->zone_list, &info->zone_list); |
| info->zone_list_size++; |
| |
| if (in_own_cluster(net, node)) { |
| list_add(&publ->cluster_list, &info->cluster_list); |
| info->cluster_list_size++; |
| } |
| |
| if (in_own_node(net, node)) { |
| list_add(&publ->node_list, &info->node_list); |
| info->node_list_size++; |
| } |
| |
| /* Any subscriptions waiting for notification? */ |
| list_for_each_entry_safe(s, st, &nseq->subscriptions, nameseq_list) { |
| tipc_subscrp_report_overlap(s, publ->lower, publ->upper, |
| TIPC_PUBLISHED, publ->ref, |
| publ->node, created_subseq); |
| } |
| return publ; |
| } |
| |
| /** |
| * tipc_nameseq_remove_publ |
| * |
| * NOTE: There may be cases where TIPC is asked to remove a publication |
| * that is not in the name table. For example, if another node issues a |
| * publication for a name sequence that overlaps an existing name sequence |
| * the publication will not be recorded, which means the publication won't |
| * be found when the name sequence is later withdrawn by that node. |
| * A failed withdraw request simply returns a failure indication and lets the |
| * caller issue any error or warning messages associated with such a problem. |
| */ |
| static struct publication *tipc_nameseq_remove_publ(struct net *net, |
| struct name_seq *nseq, |
| u32 inst, u32 node, |
| u32 ref, u32 key) |
| { |
| struct publication *publ; |
| struct sub_seq *sseq = nameseq_find_subseq(nseq, inst); |
| struct name_info *info; |
| struct sub_seq *free; |
| struct tipc_subscription *s, *st; |
| int removed_subseq = 0; |
| |
| if (!sseq) |
| return NULL; |
| |
| info = sseq->info; |
| |
| /* Locate publication, if it exists */ |
| list_for_each_entry(publ, &info->zone_list, zone_list) { |
| if ((publ->key == key) && (publ->ref == ref) && |
| (!publ->node || (publ->node == node))) |
| goto found; |
| } |
| return NULL; |
| |
| found: |
| /* Remove publication from zone scope list */ |
| list_del(&publ->zone_list); |
| info->zone_list_size--; |
| |
| /* Remove publication from cluster scope list, if present */ |
| if (in_own_cluster(net, node)) { |
| list_del(&publ->cluster_list); |
| info->cluster_list_size--; |
| } |
| |
| /* Remove publication from node scope list, if present */ |
| if (in_own_node(net, node)) { |
| list_del(&publ->node_list); |
| info->node_list_size--; |
| } |
| |
| /* Contract subseq list if no more publications for that subseq */ |
| if (list_empty(&info->zone_list)) { |
| kfree(info); |
| free = &nseq->sseqs[nseq->first_free--]; |
| memmove(sseq, sseq + 1, (free - (sseq + 1)) * sizeof(*sseq)); |
| removed_subseq = 1; |
| } |
| |
| /* Notify any waiting subscriptions */ |
| list_for_each_entry_safe(s, st, &nseq->subscriptions, nameseq_list) { |
| tipc_subscrp_report_overlap(s, publ->lower, publ->upper, |
| TIPC_WITHDRAWN, publ->ref, |
| publ->node, removed_subseq); |
| } |
| |
| return publ; |
| } |
| |
| /** |
| * tipc_nameseq_subscribe - attach a subscription, and issue |
| * the prescribed number of events if there is any sub- |
| * sequence overlapping with the requested sequence |
| */ |
| static void tipc_nameseq_subscribe(struct name_seq *nseq, |
| struct tipc_subscription *s) |
| { |
| struct sub_seq *sseq = nseq->sseqs; |
| struct tipc_name_seq ns; |
| |
| tipc_subscrp_convert_seq(&s->evt.s.seq, s->swap, &ns); |
| |
| tipc_subscrp_get(s); |
| list_add(&s->nameseq_list, &nseq->subscriptions); |
| |
| if (!sseq) |
| return; |
| |
| while (sseq != &nseq->sseqs[nseq->first_free]) { |
| if (tipc_subscrp_check_overlap(&ns, sseq->lower, sseq->upper)) { |
| struct publication *crs; |
| struct name_info *info = sseq->info; |
| int must_report = 1; |
| |
| list_for_each_entry(crs, &info->zone_list, zone_list) { |
| tipc_subscrp_report_overlap(s, sseq->lower, |
| sseq->upper, |
| TIPC_PUBLISHED, |
| crs->ref, crs->node, |
| must_report); |
| must_report = 0; |
| } |
| } |
| sseq++; |
| } |
| } |
| |
| static struct name_seq *nametbl_find_seq(struct net *net, u32 type) |
| { |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| struct hlist_head *seq_head; |
| struct name_seq *ns; |
| |
| seq_head = &tn->nametbl->seq_hlist[hash(type)]; |
| hlist_for_each_entry_rcu(ns, seq_head, ns_list) { |
| if (ns->type == type) |
| return ns; |
| } |
| |
| return NULL; |
| }; |
| |
| struct publication *tipc_nametbl_insert_publ(struct net *net, u32 type, |
| u32 lower, u32 upper, u32 scope, |
| u32 node, u32 port, u32 key) |
| { |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| struct publication *publ; |
| struct name_seq *seq = nametbl_find_seq(net, type); |
| int index = hash(type); |
| |
| if ((scope < TIPC_ZONE_SCOPE) || (scope > TIPC_NODE_SCOPE) || |
| (lower > upper)) { |
| pr_debug("Failed to publish illegal {%u,%u,%u} with scope %u\n", |
| type, lower, upper, scope); |
| return NULL; |
| } |
| |
| if (!seq) |
| seq = tipc_nameseq_create(type, &tn->nametbl->seq_hlist[index]); |
| if (!seq) |
| return NULL; |
| |
| spin_lock_bh(&seq->lock); |
| publ = tipc_nameseq_insert_publ(net, seq, type, lower, upper, |
| scope, node, port, key); |
| spin_unlock_bh(&seq->lock); |
| return publ; |
| } |
| |
| struct publication *tipc_nametbl_remove_publ(struct net *net, u32 type, |
| u32 lower, u32 node, u32 ref, |
| u32 key) |
| { |
| struct publication *publ; |
| struct name_seq *seq = nametbl_find_seq(net, type); |
| |
| if (!seq) |
| return NULL; |
| |
| spin_lock_bh(&seq->lock); |
| publ = tipc_nameseq_remove_publ(net, seq, lower, node, ref, key); |
| if (!seq->first_free && list_empty(&seq->subscriptions)) { |
| hlist_del_init_rcu(&seq->ns_list); |
| kfree(seq->sseqs); |
| spin_unlock_bh(&seq->lock); |
| kfree_rcu(seq, rcu); |
| return publ; |
| } |
| spin_unlock_bh(&seq->lock); |
| return publ; |
| } |
| |
| /** |
| * tipc_nametbl_translate - perform name translation |
| * |
| * On entry, 'destnode' is the search domain used during translation. |
| * |
| * On exit: |
| * - if name translation is deferred to another node/cluster/zone, |
| * leaves 'destnode' unchanged (will be non-zero) and returns 0 |
| * - if name translation is attempted and succeeds, sets 'destnode' |
| * to publishing node and returns port reference (will be non-zero) |
| * - if name translation is attempted and fails, sets 'destnode' to 0 |
| * and returns 0 |
| */ |
| u32 tipc_nametbl_translate(struct net *net, u32 type, u32 instance, |
| u32 *destnode) |
| { |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| struct sub_seq *sseq; |
| struct name_info *info; |
| struct publication *publ; |
| struct name_seq *seq; |
| u32 ref = 0; |
| u32 node = 0; |
| |
| if (!tipc_in_scope(*destnode, tn->own_addr)) |
| return 0; |
| |
| rcu_read_lock(); |
| seq = nametbl_find_seq(net, type); |
| if (unlikely(!seq)) |
| goto not_found; |
| spin_lock_bh(&seq->lock); |
| sseq = nameseq_find_subseq(seq, instance); |
| if (unlikely(!sseq)) |
| goto no_match; |
| info = sseq->info; |
| |
| /* Closest-First Algorithm */ |
| if (likely(!*destnode)) { |
| if (!list_empty(&info->node_list)) { |
| publ = list_first_entry(&info->node_list, |
| struct publication, |
| node_list); |
| list_move_tail(&publ->node_list, |
| &info->node_list); |
| } else if (!list_empty(&info->cluster_list)) { |
| publ = list_first_entry(&info->cluster_list, |
| struct publication, |
| cluster_list); |
| list_move_tail(&publ->cluster_list, |
| &info->cluster_list); |
| } else { |
| publ = list_first_entry(&info->zone_list, |
| struct publication, |
| zone_list); |
| list_move_tail(&publ->zone_list, |
| &info->zone_list); |
| } |
| } |
| |
| /* Round-Robin Algorithm */ |
| else if (*destnode == tn->own_addr) { |
| if (list_empty(&info->node_list)) |
| goto no_match; |
| publ = list_first_entry(&info->node_list, struct publication, |
| node_list); |
| list_move_tail(&publ->node_list, &info->node_list); |
| } else if (in_own_cluster_exact(net, *destnode)) { |
| if (list_empty(&info->cluster_list)) |
| goto no_match; |
| publ = list_first_entry(&info->cluster_list, struct publication, |
| cluster_list); |
| list_move_tail(&publ->cluster_list, &info->cluster_list); |
| } else { |
| publ = list_first_entry(&info->zone_list, struct publication, |
| zone_list); |
| list_move_tail(&publ->zone_list, &info->zone_list); |
| } |
| |
| ref = publ->ref; |
| node = publ->node; |
| no_match: |
| spin_unlock_bh(&seq->lock); |
| not_found: |
| rcu_read_unlock(); |
| *destnode = node; |
| return ref; |
| } |
| |
| bool tipc_nametbl_lookup(struct net *net, u32 type, u32 instance, u32 domain, |
| struct list_head *dsts, int *dstcnt, u32 exclude, |
| bool all) |
| { |
| u32 self = tipc_own_addr(net); |
| struct publication *publ; |
| struct name_info *info; |
| struct name_seq *seq; |
| struct sub_seq *sseq; |
| |
| if (!tipc_in_scope(domain, self)) |
| return false; |
| |
| *dstcnt = 0; |
| rcu_read_lock(); |
| seq = nametbl_find_seq(net, type); |
| if (unlikely(!seq)) |
| goto exit; |
| spin_lock_bh(&seq->lock); |
| sseq = nameseq_find_subseq(seq, instance); |
| if (likely(sseq)) { |
| info = sseq->info; |
| list_for_each_entry(publ, &info->zone_list, zone_list) { |
| if (!tipc_in_scope(domain, publ->node)) |
| continue; |
| if (publ->ref == exclude && publ->node == self) |
| continue; |
| tipc_dest_push(dsts, publ->node, publ->ref); |
| (*dstcnt)++; |
| if (all) |
| continue; |
| list_move_tail(&publ->zone_list, &info->zone_list); |
| break; |
| } |
| } |
| spin_unlock_bh(&seq->lock); |
| exit: |
| rcu_read_unlock(); |
| return !list_empty(dsts); |
| } |
| |
| int tipc_nametbl_mc_translate(struct net *net, u32 type, u32 lower, u32 upper, |
| u32 limit, struct list_head *dports) |
| { |
| struct name_seq *seq; |
| struct sub_seq *sseq; |
| struct sub_seq *sseq_stop; |
| struct name_info *info; |
| int res = 0; |
| |
| rcu_read_lock(); |
| seq = nametbl_find_seq(net, type); |
| if (!seq) |
| goto exit; |
| |
| spin_lock_bh(&seq->lock); |
| sseq = seq->sseqs + nameseq_locate_subseq(seq, lower); |
| sseq_stop = seq->sseqs + seq->first_free; |
| for (; sseq != sseq_stop; sseq++) { |
| struct publication *publ; |
| |
| if (sseq->lower > upper) |
| break; |
| |
| info = sseq->info; |
| list_for_each_entry(publ, &info->node_list, node_list) { |
| if (publ->scope <= limit) |
| tipc_dest_push(dports, 0, publ->ref); |
| } |
| |
| if (info->cluster_list_size != info->node_list_size) |
| res = 1; |
| } |
| spin_unlock_bh(&seq->lock); |
| exit: |
| rcu_read_unlock(); |
| return res; |
| } |
| |
| /* tipc_nametbl_lookup_dst_nodes - find broadcast destination nodes |
| * - Creates list of nodes that overlap the given multicast address |
| * - Determines if any node local ports overlap |
| */ |
| void tipc_nametbl_lookup_dst_nodes(struct net *net, u32 type, u32 lower, |
| u32 upper, u32 domain, |
| struct tipc_nlist *nodes) |
| { |
| struct sub_seq *sseq, *stop; |
| struct publication *publ; |
| struct name_info *info; |
| struct name_seq *seq; |
| |
| rcu_read_lock(); |
| seq = nametbl_find_seq(net, type); |
| if (!seq) |
| goto exit; |
| |
| spin_lock_bh(&seq->lock); |
| sseq = seq->sseqs + nameseq_locate_subseq(seq, lower); |
| stop = seq->sseqs + seq->first_free; |
| for (; sseq != stop && sseq->lower <= upper; sseq++) { |
| info = sseq->info; |
| list_for_each_entry(publ, &info->zone_list, zone_list) { |
| if (tipc_in_scope(domain, publ->node)) |
| tipc_nlist_add(nodes, publ->node); |
| } |
| } |
| spin_unlock_bh(&seq->lock); |
| exit: |
| rcu_read_unlock(); |
| } |
| |
| /* tipc_nametbl_build_group - build list of communication group members |
| */ |
| void tipc_nametbl_build_group(struct net *net, struct tipc_group *grp, |
| u32 type, u32 domain) |
| { |
| struct sub_seq *sseq, *stop; |
| struct name_info *info; |
| struct publication *p; |
| struct name_seq *seq; |
| |
| rcu_read_lock(); |
| seq = nametbl_find_seq(net, type); |
| if (!seq) |
| goto exit; |
| |
| spin_lock_bh(&seq->lock); |
| sseq = seq->sseqs; |
| stop = seq->sseqs + seq->first_free; |
| for (; sseq != stop; sseq++) { |
| info = sseq->info; |
| list_for_each_entry(p, &info->zone_list, zone_list) { |
| if (!tipc_in_scope(domain, p->node)) |
| continue; |
| tipc_group_add_member(grp, p->node, p->ref); |
| } |
| } |
| spin_unlock_bh(&seq->lock); |
| exit: |
| rcu_read_unlock(); |
| } |
| |
| /* |
| * tipc_nametbl_publish - add name publication to network name tables |
| */ |
| struct publication *tipc_nametbl_publish(struct net *net, u32 type, u32 lower, |
| u32 upper, u32 scope, u32 port_ref, |
| u32 key) |
| { |
| struct publication *publ; |
| struct sk_buff *buf = NULL; |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| |
| spin_lock_bh(&tn->nametbl_lock); |
| if (tn->nametbl->local_publ_count >= TIPC_MAX_PUBLICATIONS) { |
| pr_warn("Publication failed, local publication limit reached (%u)\n", |
| TIPC_MAX_PUBLICATIONS); |
| spin_unlock_bh(&tn->nametbl_lock); |
| return NULL; |
| } |
| |
| publ = tipc_nametbl_insert_publ(net, type, lower, upper, scope, |
| tn->own_addr, port_ref, key); |
| if (likely(publ)) { |
| tn->nametbl->local_publ_count++; |
| buf = tipc_named_publish(net, publ); |
| /* Any pending external events? */ |
| tipc_named_process_backlog(net); |
| } |
| spin_unlock_bh(&tn->nametbl_lock); |
| |
| if (buf) |
| tipc_node_broadcast(net, buf); |
| return publ; |
| } |
| |
| /** |
| * tipc_nametbl_withdraw - withdraw name publication from network name tables |
| */ |
| int tipc_nametbl_withdraw(struct net *net, u32 type, u32 lower, u32 ref, |
| u32 key) |
| { |
| struct publication *publ; |
| struct sk_buff *skb = NULL; |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| |
| spin_lock_bh(&tn->nametbl_lock); |
| publ = tipc_nametbl_remove_publ(net, type, lower, tn->own_addr, |
| ref, key); |
| if (likely(publ)) { |
| tn->nametbl->local_publ_count--; |
| skb = tipc_named_withdraw(net, publ); |
| /* Any pending external events? */ |
| tipc_named_process_backlog(net); |
| list_del_init(&publ->pport_list); |
| kfree_rcu(publ, rcu); |
| } else { |
| pr_err("Unable to remove local publication\n" |
| "(type=%u, lower=%u, ref=%u, key=%u)\n", |
| type, lower, ref, key); |
| } |
| spin_unlock_bh(&tn->nametbl_lock); |
| |
| if (skb) { |
| tipc_node_broadcast(net, skb); |
| return 1; |
| } |
| return 0; |
| } |
| |
| /** |
| * tipc_nametbl_subscribe - add a subscription object to the name table |
| */ |
| void tipc_nametbl_subscribe(struct tipc_subscription *s) |
| { |
| struct tipc_net *tn = net_generic(s->net, tipc_net_id); |
| u32 type = tipc_subscrp_convert_seq_type(s->evt.s.seq.type, s->swap); |
| int index = hash(type); |
| struct name_seq *seq; |
| struct tipc_name_seq ns; |
| |
| spin_lock_bh(&tn->nametbl_lock); |
| seq = nametbl_find_seq(s->net, type); |
| if (!seq) |
| seq = tipc_nameseq_create(type, &tn->nametbl->seq_hlist[index]); |
| if (seq) { |
| spin_lock_bh(&seq->lock); |
| tipc_nameseq_subscribe(seq, s); |
| spin_unlock_bh(&seq->lock); |
| } else { |
| tipc_subscrp_convert_seq(&s->evt.s.seq, s->swap, &ns); |
| pr_warn("Failed to create subscription for {%u,%u,%u}\n", |
| ns.type, ns.lower, ns.upper); |
| } |
| spin_unlock_bh(&tn->nametbl_lock); |
| } |
| |
| /** |
| * tipc_nametbl_unsubscribe - remove a subscription object from name table |
| */ |
| void tipc_nametbl_unsubscribe(struct tipc_subscription *s) |
| { |
| struct tipc_net *tn = net_generic(s->net, tipc_net_id); |
| struct name_seq *seq; |
| u32 type = tipc_subscrp_convert_seq_type(s->evt.s.seq.type, s->swap); |
| |
| spin_lock_bh(&tn->nametbl_lock); |
| seq = nametbl_find_seq(s->net, type); |
| if (seq != NULL) { |
| spin_lock_bh(&seq->lock); |
| list_del_init(&s->nameseq_list); |
| tipc_subscrp_put(s); |
| if (!seq->first_free && list_empty(&seq->subscriptions)) { |
| hlist_del_init_rcu(&seq->ns_list); |
| kfree(seq->sseqs); |
| spin_unlock_bh(&seq->lock); |
| kfree_rcu(seq, rcu); |
| } else { |
| spin_unlock_bh(&seq->lock); |
| } |
| } |
| spin_unlock_bh(&tn->nametbl_lock); |
| } |
| |
| int tipc_nametbl_init(struct net *net) |
| { |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| struct name_table *tipc_nametbl; |
| int i; |
| |
| tipc_nametbl = kzalloc(sizeof(*tipc_nametbl), GFP_ATOMIC); |
| if (!tipc_nametbl) |
| return -ENOMEM; |
| |
| for (i = 0; i < TIPC_NAMETBL_SIZE; i++) |
| INIT_HLIST_HEAD(&tipc_nametbl->seq_hlist[i]); |
| |
| INIT_LIST_HEAD(&tipc_nametbl->publ_list[TIPC_ZONE_SCOPE]); |
| INIT_LIST_HEAD(&tipc_nametbl->publ_list[TIPC_CLUSTER_SCOPE]); |
| INIT_LIST_HEAD(&tipc_nametbl->publ_list[TIPC_NODE_SCOPE]); |
| tn->nametbl = tipc_nametbl; |
| spin_lock_init(&tn->nametbl_lock); |
| return 0; |
| } |
| |
| /** |
| * tipc_purge_publications - remove all publications for a given type |
| * |
| * tipc_nametbl_lock must be held when calling this function |
| */ |
| static void tipc_purge_publications(struct net *net, struct name_seq *seq) |
| { |
| struct publication *publ, *safe; |
| struct sub_seq *sseq; |
| struct name_info *info; |
| |
| spin_lock_bh(&seq->lock); |
| sseq = seq->sseqs; |
| info = sseq->info; |
| list_for_each_entry_safe(publ, safe, &info->zone_list, zone_list) { |
| tipc_nameseq_remove_publ(net, seq, publ->lower, publ->node, |
| publ->ref, publ->key); |
| kfree_rcu(publ, rcu); |
| } |
| hlist_del_init_rcu(&seq->ns_list); |
| kfree(seq->sseqs); |
| spin_unlock_bh(&seq->lock); |
| |
| kfree_rcu(seq, rcu); |
| } |
| |
| void tipc_nametbl_stop(struct net *net) |
| { |
| u32 i; |
| struct name_seq *seq; |
| struct hlist_head *seq_head; |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| struct name_table *tipc_nametbl = tn->nametbl; |
| |
| /* Verify name table is empty and purge any lingering |
| * publications, then release the name table |
| */ |
| spin_lock_bh(&tn->nametbl_lock); |
| for (i = 0; i < TIPC_NAMETBL_SIZE; i++) { |
| if (hlist_empty(&tipc_nametbl->seq_hlist[i])) |
| continue; |
| seq_head = &tipc_nametbl->seq_hlist[i]; |
| hlist_for_each_entry_rcu(seq, seq_head, ns_list) { |
| tipc_purge_publications(net, seq); |
| } |
| } |
| spin_unlock_bh(&tn->nametbl_lock); |
| |
| synchronize_net(); |
| kfree(tipc_nametbl); |
| |
| } |
| |
| static int __tipc_nl_add_nametable_publ(struct tipc_nl_msg *msg, |
| struct name_seq *seq, |
| struct sub_seq *sseq, u32 *last_publ) |
| { |
| void *hdr; |
| struct nlattr *attrs; |
| struct nlattr *publ; |
| struct publication *p; |
| |
| if (*last_publ) { |
| list_for_each_entry(p, &sseq->info->zone_list, zone_list) |
| if (p->key == *last_publ) |
| break; |
| if (p->key != *last_publ) |
| return -EPIPE; |
| } else { |
| p = list_first_entry(&sseq->info->zone_list, struct publication, |
| zone_list); |
| } |
| |
| list_for_each_entry_from(p, &sseq->info->zone_list, zone_list) { |
| *last_publ = p->key; |
| |
| hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, |
| &tipc_genl_family, NLM_F_MULTI, |
| TIPC_NL_NAME_TABLE_GET); |
| if (!hdr) |
| return -EMSGSIZE; |
| |
| attrs = nla_nest_start(msg->skb, TIPC_NLA_NAME_TABLE); |
| if (!attrs) |
| goto msg_full; |
| |
| publ = nla_nest_start(msg->skb, TIPC_NLA_NAME_TABLE_PUBL); |
| if (!publ) |
| goto attr_msg_full; |
| |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_TYPE, seq->type)) |
| goto publ_msg_full; |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_LOWER, sseq->lower)) |
| goto publ_msg_full; |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_UPPER, sseq->upper)) |
| goto publ_msg_full; |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_SCOPE, p->scope)) |
| goto publ_msg_full; |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_NODE, p->node)) |
| goto publ_msg_full; |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_REF, p->ref)) |
| goto publ_msg_full; |
| if (nla_put_u32(msg->skb, TIPC_NLA_PUBL_KEY, p->key)) |
| goto publ_msg_full; |
| |
| nla_nest_end(msg->skb, publ); |
| nla_nest_end(msg->skb, attrs); |
| genlmsg_end(msg->skb, hdr); |
| } |
| *last_publ = 0; |
| |
| return 0; |
| |
| publ_msg_full: |
| nla_nest_cancel(msg->skb, publ); |
| attr_msg_full: |
| nla_nest_cancel(msg->skb, attrs); |
| msg_full: |
| genlmsg_cancel(msg->skb, hdr); |
| |
| return -EMSGSIZE; |
| } |
| |
| static int __tipc_nl_subseq_list(struct tipc_nl_msg *msg, struct name_seq *seq, |
| u32 *last_lower, u32 *last_publ) |
| { |
| struct sub_seq *sseq; |
| struct sub_seq *sseq_start; |
| int err; |
| |
| if (*last_lower) { |
| sseq_start = nameseq_find_subseq(seq, *last_lower); |
| if (!sseq_start) |
| return -EPIPE; |
| } else { |
| sseq_start = seq->sseqs; |
| } |
| |
| for (sseq = sseq_start; sseq != &seq->sseqs[seq->first_free]; sseq++) { |
| err = __tipc_nl_add_nametable_publ(msg, seq, sseq, last_publ); |
| if (err) { |
| *last_lower = sseq->lower; |
| return err; |
| } |
| } |
| *last_lower = 0; |
| |
| return 0; |
| } |
| |
| static int tipc_nl_seq_list(struct net *net, struct tipc_nl_msg *msg, |
| u32 *last_type, u32 *last_lower, u32 *last_publ) |
| { |
| struct tipc_net *tn = net_generic(net, tipc_net_id); |
| struct hlist_head *seq_head; |
| struct name_seq *seq = NULL; |
| int err; |
| int i; |
| |
| if (*last_type) |
| i = hash(*last_type); |
| else |
| i = 0; |
| |
| for (; i < TIPC_NAMETBL_SIZE; i++) { |
| seq_head = &tn->nametbl->seq_hlist[i]; |
| |
| if (*last_type) { |
| seq = nametbl_find_seq(net, *last_type); |
| if (!seq) |
| return -EPIPE; |
| } else { |
| hlist_for_each_entry_rcu(seq, seq_head, ns_list) |
| break; |
| if (!seq) |
| continue; |
| } |
| |
| hlist_for_each_entry_from_rcu(seq, ns_list) { |
| spin_lock_bh(&seq->lock); |
| err = __tipc_nl_subseq_list(msg, seq, last_lower, |
| last_publ); |
| |
| if (err) { |
| *last_type = seq->type; |
| spin_unlock_bh(&seq->lock); |
| return err; |
| } |
| spin_unlock_bh(&seq->lock); |
| } |
| *last_type = 0; |
| } |
| return 0; |
| } |
| |
| int tipc_nl_name_table_dump(struct sk_buff *skb, struct netlink_callback *cb) |
| { |
| int err; |
| int done = cb->args[3]; |
| u32 last_type = cb->args[0]; |
| u32 last_lower = cb->args[1]; |
| u32 last_publ = cb->args[2]; |
| struct net *net = sock_net(skb->sk); |
| struct tipc_nl_msg msg; |
| |
| if (done) |
| return 0; |
| |
| msg.skb = skb; |
| msg.portid = NETLINK_CB(cb->skb).portid; |
| msg.seq = cb->nlh->nlmsg_seq; |
| |
| rcu_read_lock(); |
| err = tipc_nl_seq_list(net, &msg, &last_type, &last_lower, &last_publ); |
| if (!err) { |
| done = 1; |
| } else if (err != -EMSGSIZE) { |
| /* We never set seq or call nl_dump_check_consistent() this |
| * means that setting prev_seq here will cause the consistence |
| * check to fail in the netlink callback handler. Resulting in |
| * the NLMSG_DONE message having the NLM_F_DUMP_INTR flag set if |
| * we got an error. |
| */ |
| cb->prev_seq = 1; |
| } |
| rcu_read_unlock(); |
| |
| cb->args[0] = last_type; |
| cb->args[1] = last_lower; |
| cb->args[2] = last_publ; |
| cb->args[3] = done; |
| |
| return skb->len; |
| } |
| |
| struct tipc_dest *tipc_dest_find(struct list_head *l, u32 node, u32 port) |
| { |
| u64 value = (u64)node << 32 | port; |
| struct tipc_dest *dst; |
| |
| list_for_each_entry(dst, l, list) { |
| if (dst->value != value) |
| continue; |
| return dst; |
| } |
| return NULL; |
| } |
| |
| bool tipc_dest_push(struct list_head *l, u32 node, u32 port) |
| { |
| u64 value = (u64)node << 32 | port; |
| struct tipc_dest *dst; |
| |
| if (tipc_dest_find(l, node, port)) |
| return false; |
| |
| dst = kmalloc(sizeof(*dst), GFP_ATOMIC); |
| if (unlikely(!dst)) |
| return false; |
| dst->value = value; |
| list_add(&dst->list, l); |
| return true; |
| } |
| |
| bool tipc_dest_pop(struct list_head *l, u32 *node, u32 *port) |
| { |
| struct tipc_dest *dst; |
| |
| if (list_empty(l)) |
| return false; |
| dst = list_first_entry(l, typeof(*dst), list); |
| if (port) |
| *port = dst->port; |
| if (node) |
| *node = dst->node; |
| list_del(&dst->list); |
| kfree(dst); |
| return true; |
| } |
| |
| bool tipc_dest_del(struct list_head *l, u32 node, u32 port) |
| { |
| struct tipc_dest *dst; |
| |
| dst = tipc_dest_find(l, node, port); |
| if (!dst) |
| return false; |
| list_del(&dst->list); |
| kfree(dst); |
| return true; |
| } |
| |
| void tipc_dest_list_purge(struct list_head *l) |
| { |
| struct tipc_dest *dst, *tmp; |
| |
| list_for_each_entry_safe(dst, tmp, l, list) { |
| list_del(&dst->list); |
| kfree(dst); |
| } |
| } |
| |
| int tipc_dest_list_len(struct list_head *l) |
| { |
| struct tipc_dest *dst; |
| int i = 0; |
| |
| list_for_each_entry(dst, l, list) { |
| i++; |
| } |
| return i; |
| } |