| xj | b04a402 | 2021-11-25 15:01:52 +0800 | [diff] [blame] | 1 | /* | 
 | 2 |  * Linux WiMAX | 
 | 3 |  * Mappping of generic netlink family IDs to net devices | 
 | 4 |  * | 
 | 5 |  * | 
 | 6 |  * Copyright (C) 2005-2006 Intel Corporation <linux-wimax@intel.com> | 
 | 7 |  * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | 
 | 8 |  * | 
 | 9 |  * This program is free software; you can redistribute it and/or | 
 | 10 |  * modify it under the terms of the GNU General Public License version | 
 | 11 |  * 2 as published by the Free Software Foundation. | 
 | 12 |  * | 
 | 13 |  * This program is distributed in the hope that it will be useful, | 
 | 14 |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 15 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 16 |  * GNU General Public License for more details. | 
 | 17 |  * | 
 | 18 |  * You should have received a copy of the GNU General Public License | 
 | 19 |  * along with this program; if not, write to the Free Software | 
 | 20 |  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | 
 | 21 |  * 02110-1301, USA. | 
 | 22 |  * | 
 | 23 |  * | 
 | 24 |  * We assign a single generic netlink family ID to each device (to | 
 | 25 |  * simplify lookup). | 
 | 26 |  * | 
 | 27 |  * We need a way to map family ID to a wimax_dev pointer. | 
 | 28 |  * | 
 | 29 |  * The idea is to use a very simple lookup. Using a netlink attribute | 
 | 30 |  * with (for example) the interface name implies a heavier search over | 
 | 31 |  * all the network devices; seemed kind of a waste given that we know | 
 | 32 |  * we are looking for a WiMAX device and that most systems will have | 
 | 33 |  * just a single WiMAX adapter. | 
 | 34 |  * | 
 | 35 |  * We put all the WiMAX devices in the system in a linked list and | 
 | 36 |  * match the generic link family ID against the list. | 
 | 37 |  * | 
 | 38 |  * By using a linked list, the case of a single adapter in the system | 
 | 39 |  * becomes (almost) no overhead, while still working for many more. If | 
 | 40 |  * it ever goes beyond two, I'll be surprised. | 
 | 41 |  */ | 
 | 42 | #include <linux/device.h> | 
 | 43 | #include <net/genetlink.h> | 
 | 44 | #include <linux/netdevice.h> | 
 | 45 | #include <linux/list.h> | 
 | 46 | #include <linux/wimax.h> | 
 | 47 | #include "wimax-internal.h" | 
 | 48 |  | 
 | 49 |  | 
 | 50 | #define D_SUBMODULE id_table | 
 | 51 | #include "debug-levels.h" | 
 | 52 |  | 
 | 53 |  | 
 | 54 | static DEFINE_SPINLOCK(wimax_id_table_lock); | 
 | 55 | static struct list_head wimax_id_table = LIST_HEAD_INIT(wimax_id_table); | 
 | 56 |  | 
 | 57 |  | 
 | 58 | /* | 
 | 59 |  * wimax_id_table_add - add a gennetlink familiy ID / wimax_dev mapping | 
 | 60 |  * | 
 | 61 |  * @wimax_dev: WiMAX device descriptor to associate to the Generic | 
 | 62 |  *     Netlink family ID. | 
 | 63 |  * | 
 | 64 |  * Look for an empty spot in the ID table; if none found, double the | 
 | 65 |  * table's size and get the first spot. | 
 | 66 |  */ | 
 | 67 | void wimax_id_table_add(struct wimax_dev *wimax_dev) | 
 | 68 | { | 
 | 69 | 	d_fnstart(3, NULL, "(wimax_dev %p)\n", wimax_dev); | 
 | 70 | 	spin_lock(&wimax_id_table_lock); | 
 | 71 | 	list_add(&wimax_dev->id_table_node, &wimax_id_table); | 
 | 72 | 	spin_unlock(&wimax_id_table_lock); | 
 | 73 | 	d_fnend(3, NULL, "(wimax_dev %p)\n", wimax_dev); | 
 | 74 | } | 
 | 75 |  | 
 | 76 |  | 
 | 77 | /* | 
 | 78 |  * wimax_get_netdev_by_info - lookup a wimax_dev from the gennetlink info | 
 | 79 |  * | 
 | 80 |  * The generic netlink family ID has been filled out in the | 
 | 81 |  * nlmsghdr->nlmsg_type field, so we pull it from there, look it up in | 
 | 82 |  * the mapping table and reference the wimax_dev. | 
 | 83 |  * | 
 | 84 |  * When done, the reference should be dropped with | 
 | 85 |  * 'dev_put(wimax_dev->net_dev)'. | 
 | 86 |  */ | 
 | 87 | struct wimax_dev *wimax_dev_get_by_genl_info( | 
 | 88 | 	struct genl_info *info, int ifindex) | 
 | 89 | { | 
 | 90 | 	struct wimax_dev *wimax_dev = NULL; | 
 | 91 |  | 
 | 92 | 	d_fnstart(3, NULL, "(info %p ifindex %d)\n", info, ifindex); | 
 | 93 | 	spin_lock(&wimax_id_table_lock); | 
 | 94 | 	list_for_each_entry(wimax_dev, &wimax_id_table, id_table_node) { | 
 | 95 | 		if (wimax_dev->net_dev->ifindex == ifindex) { | 
 | 96 | 			dev_hold(wimax_dev->net_dev); | 
 | 97 | 			goto found; | 
 | 98 | 		} | 
 | 99 | 	} | 
 | 100 | 	wimax_dev = NULL; | 
 | 101 | 	d_printf(1, NULL, "wimax: no devices found with ifindex %d\n", | 
 | 102 | 		 ifindex); | 
 | 103 | found: | 
 | 104 | 	spin_unlock(&wimax_id_table_lock); | 
 | 105 | 	d_fnend(3, NULL, "(info %p ifindex %d) = %p\n", | 
 | 106 | 		info, ifindex, wimax_dev); | 
 | 107 | 	return wimax_dev; | 
 | 108 | } | 
 | 109 |  | 
 | 110 |  | 
 | 111 | /* | 
 | 112 |  * wimax_id_table_rm - Remove a gennetlink familiy ID / wimax_dev mapping | 
 | 113 |  * | 
 | 114 |  * @id: family ID to remove from the table | 
 | 115 |  */ | 
 | 116 | void wimax_id_table_rm(struct wimax_dev *wimax_dev) | 
 | 117 | { | 
 | 118 | 	spin_lock(&wimax_id_table_lock); | 
 | 119 | 	list_del_init(&wimax_dev->id_table_node); | 
 | 120 | 	spin_unlock(&wimax_id_table_lock); | 
 | 121 | } | 
 | 122 |  | 
 | 123 |  | 
 | 124 | /* | 
 | 125 |  * Release the gennetlink family id / mapping table | 
 | 126 |  * | 
 | 127 |  * On debug, verify that the table is empty upon removal. We want the | 
 | 128 |  * code always compiled, to ensure it doesn't bit rot. It will be | 
 | 129 |  * compiled out if CONFIG_BUG is disabled. | 
 | 130 |  */ | 
 | 131 | void wimax_id_table_release(void) | 
 | 132 | { | 
 | 133 | 	struct wimax_dev *wimax_dev; | 
 | 134 |  | 
 | 135 | #ifndef CONFIG_BUG | 
 | 136 | 	return; | 
 | 137 | #endif | 
 | 138 | 	spin_lock(&wimax_id_table_lock); | 
 | 139 | 	list_for_each_entry(wimax_dev, &wimax_id_table, id_table_node) { | 
 | 140 | 		pr_err("BUG: %s wimax_dev %p ifindex %d not cleared\n", | 
 | 141 | 		       __func__, wimax_dev, wimax_dev->net_dev->ifindex); | 
 | 142 | 		WARN_ON(1); | 
 | 143 | 	} | 
 | 144 | 	spin_unlock(&wimax_id_table_lock); | 
 | 145 | } |