net/ieee802154/core.c

   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  */
  14
  15 #include <linux/slab.h>
  16 #include <linux/kernel.h>
  17 #include <linux/module.h>
  18 #include <linux/device.h>
  19
  20 #include <net/cfg802154.h>
  21
  22 #include "ieee802154.h"
  23 #include "sysfs.h"
  24
  25 static DEFINE_MUTEX(wpan_phy_mutex);
  26 static int wpan_phy_idx;
  27
  28 static int wpan_phy_match(struct device *dev, const void *data)
  29 {
  30         return !strcmp(dev_name(dev), (const char *)data);
  31 }
  32
  33 struct wpan_phy *wpan_phy_find(const char *str)
  34 {
  35         struct device *dev;
  36
  37         if (WARN_ON(!str))
  38                 return NULL;
  39
  40         dev = class_find_device(&wpan_phy_class, NULL, str, wpan_phy_match);
  41         if (!dev)
  42                 return NULL;
  43
  44         return container_of(dev, struct wpan_phy, dev);
  45 }
  46 EXPORT_SYMBOL(wpan_phy_find);
  47
  48 struct wpan_phy_iter_data {
  49         int (*fn)(struct wpan_phy *phy, void *data);
  50         void *data;
  51 };
  52
  53 static int wpan_phy_iter(struct device *dev, void *_data)
  54 {
  55         struct wpan_phy_iter_data *wpid = _data;
  56         struct wpan_phy *phy = container_of(dev, struct wpan_phy, dev);
  57
  58         return wpid->fn(phy, wpid->data);
  59 }
  60
  61 int wpan_phy_for_each(int (*fn)(struct wpan_phy *phy, void *data),
  62                       void *data)
  63 {
  64         struct wpan_phy_iter_data wpid = {
  65                 .fn = fn,
  66                 .data = data,
  67         };
  68
  69         return class_for_each_device(&wpan_phy_class, NULL,
  70                         &wpid, wpan_phy_iter);
  71 }
  72 EXPORT_SYMBOL(wpan_phy_for_each);
  73
  74 static int wpan_phy_idx_valid(int idx)
  75 {
  76         return idx >= 0;
  77 }
  78
  79 struct wpan_phy *wpan_phy_alloc(size_t priv_size)
  80 {
  81         struct wpan_phy *phy = kzalloc(sizeof(*phy) + priv_size,
  82                         GFP_KERNEL);
  83
  84         if (!phy)
  85                 goto out;
  86         mutex_lock(&wpan_phy_mutex);
  87         phy->idx = wpan_phy_idx++;
  88         if (unlikely(!wpan_phy_idx_valid(phy->idx))) {
  89                 wpan_phy_idx--;
  90                 mutex_unlock(&wpan_phy_mutex);
  91                 kfree(phy);
  92                 goto out;
  93         }
  94         mutex_unlock(&wpan_phy_mutex);
  95
  96         mutex_init(&phy->pib_lock);
  97
  98         device_initialize(&phy->dev);
  99         dev_set_name(&phy->dev, "wpan-phy%d", phy->idx);
 100
 101         phy->dev.class = &wpan_phy_class;
 102
 103         phy->current_channel = -1; /* not initialised */
 104         phy->current_page = 0; /* for compatibility */
 105
 106         return phy;
 107
 108 out:
 109         return NULL;
 110 }
 111 EXPORT_SYMBOL(wpan_phy_alloc);
 112
 113 int wpan_phy_register(struct wpan_phy *phy)
 114 {
 115         return device_add(&phy->dev);
 116 }
 117 EXPORT_SYMBOL(wpan_phy_register);
 118
 119 void wpan_phy_unregister(struct wpan_phy *phy)
 120 {
 121         device_del(&phy->dev);
 122 }
 123 EXPORT_SYMBOL(wpan_phy_unregister);
 124
 125 void wpan_phy_free(struct wpan_phy *phy)
 126 {
 127         put_device(&phy->dev);
 128 }
 129 EXPORT_SYMBOL(wpan_phy_free);
 130
 131 static int __init wpan_phy_class_init(void)
 132 {
 133         int rc;
 134
 135         rc = wpan_phy_sysfs_init();
 136         if (rc)
 137                 goto err;
 138
 139         rc = ieee802154_nl_init();
 140         if (rc)
 141                 goto err_nl;
 142
 143         return 0;
 144 err_nl:
 145         wpan_phy_sysfs_exit();
 146 err:
 147         return rc;
 148 }
 149 subsys_initcall(wpan_phy_class_init);
 150
 151 static void __exit wpan_phy_class_exit(void)
 152 {
 153         ieee802154_nl_exit();
 154         wpan_phy_sysfs_exit();
 155 }
 156 module_exit(wpan_phy_class_exit);
 157
 158 MODULE_LICENSE("GPL v2");
 159 MODULE_DESCRIPTION("IEEE 802.15.4 configuration interface");
 160 MODULE_AUTHOR("Dmitry Eremin-Solenikov");
 161