Dmitry Eremin-Solenikov | 2bfb107 | 2009-08-14 16:13:12 +0400 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2007, 2008, 2009 Siemens AG |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify |
| 5 | * it under the terms of the GNU General Public License version 2 |
| 6 | * as published by the Free Software Foundation. |
| 7 | * |
| 8 | * This program is distributed in the hope that it will be useful, |
| 9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 11 | * GNU General Public License for more details. |
| 12 | * |
| 13 | * You should have received a copy of the GNU General Public License along |
| 14 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 15 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 16 | * |
| 17 | */ |
| 18 | |
| 19 | #include <linux/kernel.h> |
| 20 | #include <linux/module.h> |
| 21 | #include <linux/device.h> |
| 22 | |
| 23 | #include <net/wpan-phy.h> |
| 24 | |
| 25 | #define MASTER_SHOW_COMPLEX(name, format_string, args...) \ |
| 26 | static ssize_t name ## _show(struct device *dev, \ |
| 27 | struct device_attribute *attr, char *buf) \ |
| 28 | { \ |
| 29 | struct wpan_phy *phy = container_of(dev, struct wpan_phy, dev); \ |
| 30 | int ret; \ |
| 31 | \ |
| 32 | mutex_lock(&phy->pib_lock); \ |
| 33 | ret = sprintf(buf, format_string "\n", args); \ |
| 34 | mutex_unlock(&phy->pib_lock); \ |
| 35 | return ret; \ |
| 36 | } |
| 37 | |
| 38 | #define MASTER_SHOW(field, format_string) \ |
| 39 | MASTER_SHOW_COMPLEX(field, format_string, phy->field) |
| 40 | |
| 41 | MASTER_SHOW(current_channel, "%d"); |
| 42 | MASTER_SHOW(current_page, "%d"); |
| 43 | MASTER_SHOW(channels_supported, "%#x"); |
| 44 | MASTER_SHOW_COMPLEX(transmit_power, "%d +- %d dB", |
| 45 | ((signed char) (phy->transmit_power << 2)) >> 2, |
| 46 | (phy->transmit_power >> 6) ? (phy->transmit_power >> 6) * 3 : 1 ); |
| 47 | MASTER_SHOW(cca_mode, "%d"); |
| 48 | |
| 49 | static struct device_attribute pmib_attrs[] = { |
| 50 | __ATTR_RO(current_channel), |
| 51 | __ATTR_RO(current_page), |
| 52 | __ATTR_RO(channels_supported), |
| 53 | __ATTR_RO(transmit_power), |
| 54 | __ATTR_RO(cca_mode), |
| 55 | {}, |
| 56 | }; |
| 57 | |
| 58 | static void wpan_phy_release(struct device *d) |
| 59 | { |
| 60 | struct wpan_phy *phy = container_of(d, struct wpan_phy, dev); |
| 61 | kfree(phy); |
| 62 | } |
| 63 | |
| 64 | static struct class wpan_phy_class = { |
| 65 | .name = "ieee802154", |
| 66 | .dev_release = wpan_phy_release, |
| 67 | .dev_attrs = pmib_attrs, |
| 68 | }; |
| 69 | |
| 70 | static DEFINE_MUTEX(wpan_phy_mutex); |
| 71 | static int wpan_phy_idx; |
| 72 | |
| 73 | static int wpan_phy_match(struct device *dev, void *data) |
| 74 | { |
| 75 | return !strcmp(dev_name(dev), (const char *)data); |
| 76 | } |
| 77 | |
| 78 | struct wpan_phy *wpan_phy_find(const char *str) |
| 79 | { |
| 80 | struct device *dev; |
| 81 | |
| 82 | if (WARN_ON(!str)) |
| 83 | return NULL; |
| 84 | |
| 85 | dev = class_find_device(&wpan_phy_class, NULL, |
| 86 | (void *)str, wpan_phy_match); |
| 87 | if (!dev) |
| 88 | return NULL; |
| 89 | |
| 90 | return container_of(dev, struct wpan_phy, dev); |
| 91 | } |
| 92 | EXPORT_SYMBOL(wpan_phy_find); |
| 93 | |
| 94 | static int wpan_phy_idx_valid(int idx) |
| 95 | { |
| 96 | return idx >= 0; |
| 97 | } |
| 98 | |
| 99 | struct wpan_phy *wpan_phy_alloc(size_t priv_size) |
| 100 | { |
| 101 | struct wpan_phy *phy = kzalloc(sizeof(*phy) + priv_size, |
| 102 | GFP_KERNEL); |
| 103 | |
| 104 | mutex_lock(&wpan_phy_mutex); |
| 105 | phy->idx = wpan_phy_idx++; |
| 106 | if (unlikely(!wpan_phy_idx_valid(phy->idx))) { |
| 107 | wpan_phy_idx--; |
| 108 | mutex_unlock(&wpan_phy_mutex); |
| 109 | kfree(phy); |
| 110 | return NULL; |
| 111 | } |
| 112 | mutex_unlock(&wpan_phy_mutex); |
| 113 | |
| 114 | mutex_init(&phy->pib_lock); |
| 115 | |
| 116 | device_initialize(&phy->dev); |
| 117 | dev_set_name(&phy->dev, "wpan-phy%d", phy->idx); |
| 118 | |
| 119 | phy->dev.class = &wpan_phy_class; |
| 120 | |
| 121 | return phy; |
| 122 | } |
| 123 | EXPORT_SYMBOL(wpan_phy_alloc); |
| 124 | |
| 125 | int wpan_phy_register(struct device *parent, struct wpan_phy *phy) |
| 126 | { |
| 127 | phy->dev.parent = parent; |
| 128 | |
| 129 | return device_add(&phy->dev); |
| 130 | } |
| 131 | EXPORT_SYMBOL(wpan_phy_register); |
| 132 | |
| 133 | void wpan_phy_unregister(struct wpan_phy *phy) |
| 134 | { |
| 135 | device_del(&phy->dev); |
| 136 | } |
| 137 | EXPORT_SYMBOL(wpan_phy_unregister); |
| 138 | |
| 139 | void wpan_phy_free(struct wpan_phy *phy) |
| 140 | { |
| 141 | put_device(&phy->dev); |
| 142 | } |
| 143 | EXPORT_SYMBOL(wpan_phy_free); |
| 144 | |
| 145 | static int __init wpan_phy_class_init(void) |
| 146 | { |
| 147 | return class_register(&wpan_phy_class); |
| 148 | } |
| 149 | subsys_initcall(wpan_phy_class_init); |
| 150 | |
| 151 | static void __exit wpan_phy_class_exit(void) |
| 152 | { |
| 153 | class_unregister(&wpan_phy_class); |
| 154 | } |
| 155 | module_exit(wpan_phy_class_exit); |
| 156 | |
| 157 | MODULE_DESCRIPTION("IEEE 802.15.4 device class"); |
| 158 | MODULE_LICENSE("GPL v2"); |
| 159 | |