]>
Commit | Line | Data |
---|---|---|
2bfb1070 DES |
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 | * | |
2bfb1070 DES |
13 | */ |
14 | ||
5a0e3ad6 | 15 | #include <linux/slab.h> |
2bfb1070 DES |
16 | #include <linux/kernel.h> |
17 | #include <linux/module.h> | |
18 | #include <linux/device.h> | |
19 | ||
5ad60d36 | 20 | #include <net/cfg802154.h> |
2bfb1070 | 21 | |
cb6b3763 | 22 | #include "ieee802154.h" |
e23e9ec1 | 23 | #include "sysfs.h" |
2bfb1070 DES |
24 | |
25 | static DEFINE_MUTEX(wpan_phy_mutex); | |
26 | static int wpan_phy_idx; | |
27 | ||
9f3b795a | 28 | static int wpan_phy_match(struct device *dev, const void *data) |
2bfb1070 DES |
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 | ||
9f3b795a | 40 | dev = class_find_device(&wpan_phy_class, NULL, str, wpan_phy_match); |
2bfb1070 DES |
41 | if (!dev) |
42 | return NULL; | |
43 | ||
44 | return container_of(dev, struct wpan_phy, dev); | |
45 | } | |
46 | EXPORT_SYMBOL(wpan_phy_find); | |
47 | ||
1c889f4d DES |
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); | |
4710d806 | 57 | |
1c889f4d DES |
58 | return wpid->fn(phy, wpid->data); |
59 | } | |
60 | ||
61 | int wpan_phy_for_each(int (*fn)(struct wpan_phy *phy, void *data), | |
4710d806 | 62 | void *data) |
1c889f4d DES |
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 | ||
2bfb1070 DES |
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 | ||
a6c0f821 DK |
84 | if (!phy) |
85 | goto out; | |
2bfb1070 DES |
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); | |
a6c0f821 | 92 | goto out; |
2bfb1070 DES |
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 | return phy; | |
a6c0f821 DK |
104 | |
105 | out: | |
106 | return NULL; | |
2bfb1070 DES |
107 | } |
108 | EXPORT_SYMBOL(wpan_phy_alloc); | |
109 | ||
e9cf356c | 110 | int wpan_phy_register(struct wpan_phy *phy) |
2bfb1070 | 111 | { |
2bfb1070 DES |
112 | return device_add(&phy->dev); |
113 | } | |
114 | EXPORT_SYMBOL(wpan_phy_register); | |
115 | ||
116 | void wpan_phy_unregister(struct wpan_phy *phy) | |
117 | { | |
118 | device_del(&phy->dev); | |
119 | } | |
120 | EXPORT_SYMBOL(wpan_phy_unregister); | |
121 | ||
122 | void wpan_phy_free(struct wpan_phy *phy) | |
123 | { | |
124 | put_device(&phy->dev); | |
125 | } | |
126 | EXPORT_SYMBOL(wpan_phy_free); | |
127 | ||
128 | static int __init wpan_phy_class_init(void) | |
129 | { | |
cb6b3763 | 130 | int rc; |
4710d806 | 131 | |
e23e9ec1 | 132 | rc = wpan_phy_sysfs_init(); |
cb6b3763 DES |
133 | if (rc) |
134 | goto err; | |
135 | ||
136 | rc = ieee802154_nl_init(); | |
137 | if (rc) | |
138 | goto err_nl; | |
139 | ||
140 | return 0; | |
141 | err_nl: | |
e23e9ec1 | 142 | wpan_phy_sysfs_exit(); |
cb6b3763 DES |
143 | err: |
144 | return rc; | |
2bfb1070 | 145 | } |
282a3954 | 146 | subsys_initcall(wpan_phy_class_init); |
2bfb1070 DES |
147 | |
148 | static void __exit wpan_phy_class_exit(void) | |
149 | { | |
cb6b3763 | 150 | ieee802154_nl_exit(); |
e23e9ec1 | 151 | wpan_phy_sysfs_exit(); |
2bfb1070 DES |
152 | } |
153 | module_exit(wpan_phy_class_exit); | |
154 | ||
2bfb1070 | 155 | MODULE_LICENSE("GPL v2"); |
cb6b3763 DES |
156 | MODULE_DESCRIPTION("IEEE 802.15.4 configuration interface"); |
157 | MODULE_AUTHOR("Dmitry Eremin-Solenikov"); | |
2bfb1070 | 158 |