1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63#include <net/wimax.h>
64#include <net/genetlink.h>
65#include <linux/wimax.h>
66#include <linux/security.h>
67#include <linux/rfkill.h>
68#include <linux/export.h>
69#include "wimax-internal.h"
70
71#define D_SUBMODULE op_rfkill
72#include "debug-levels.h"
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93void wimax_report_rfkill_hw(struct wimax_dev *wimax_dev,
94 enum wimax_rf_state state)
95{
96 int result;
97 struct device *dev = wimax_dev_to_dev(wimax_dev);
98 enum wimax_st wimax_state;
99
100 d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state);
101 BUG_ON(state == WIMAX_RF_QUERY);
102 BUG_ON(state != WIMAX_RF_ON && state != WIMAX_RF_OFF);
103
104 mutex_lock(&wimax_dev->mutex);
105 result = wimax_dev_is_ready(wimax_dev);
106 if (result < 0)
107 goto error_not_ready;
108
109 if (state != wimax_dev->rf_hw) {
110 wimax_dev->rf_hw = state;
111 if (wimax_dev->rf_hw == WIMAX_RF_ON &&
112 wimax_dev->rf_sw == WIMAX_RF_ON)
113 wimax_state = WIMAX_ST_READY;
114 else
115 wimax_state = WIMAX_ST_RADIO_OFF;
116
117 result = rfkill_set_hw_state(wimax_dev->rfkill,
118 state == WIMAX_RF_OFF);
119
120 __wimax_state_change(wimax_dev, wimax_state);
121 }
122error_not_ready:
123 mutex_unlock(&wimax_dev->mutex);
124 d_fnend(3, dev, "(wimax_dev %p state %u) = void [%d]\n",
125 wimax_dev, state, result);
126}
127EXPORT_SYMBOL_GPL(wimax_report_rfkill_hw);
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148void wimax_report_rfkill_sw(struct wimax_dev *wimax_dev,
149 enum wimax_rf_state state)
150{
151 int result;
152 struct device *dev = wimax_dev_to_dev(wimax_dev);
153 enum wimax_st wimax_state;
154
155 d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state);
156 BUG_ON(state == WIMAX_RF_QUERY);
157 BUG_ON(state != WIMAX_RF_ON && state != WIMAX_RF_OFF);
158
159 mutex_lock(&wimax_dev->mutex);
160 result = wimax_dev_is_ready(wimax_dev);
161 if (result < 0)
162 goto error_not_ready;
163
164 if (state != wimax_dev->rf_sw) {
165 wimax_dev->rf_sw = state;
166 if (wimax_dev->rf_hw == WIMAX_RF_ON &&
167 wimax_dev->rf_sw == WIMAX_RF_ON)
168 wimax_state = WIMAX_ST_READY;
169 else
170 wimax_state = WIMAX_ST_RADIO_OFF;
171 __wimax_state_change(wimax_dev, wimax_state);
172 rfkill_set_sw_state(wimax_dev->rfkill, state == WIMAX_RF_OFF);
173 }
174error_not_ready:
175 mutex_unlock(&wimax_dev->mutex);
176 d_fnend(3, dev, "(wimax_dev %p state %u) = void [%d]\n",
177 wimax_dev, state, result);
178}
179EXPORT_SYMBOL_GPL(wimax_report_rfkill_sw);
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204static
205int __wimax_rf_toggle_radio(struct wimax_dev *wimax_dev,
206 enum wimax_rf_state state)
207{
208 int result = 0;
209 struct device *dev = wimax_dev_to_dev(wimax_dev);
210 enum wimax_st wimax_state;
211
212 might_sleep();
213 d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state);
214 if (wimax_dev->rf_sw == state)
215 goto out_no_change;
216 if (wimax_dev->op_rfkill_sw_toggle != NULL)
217 result = wimax_dev->op_rfkill_sw_toggle(wimax_dev, state);
218 else if (state == WIMAX_RF_OFF)
219 result = -ENXIO;
220 else
221 result = 0;
222 if (result >= 0) {
223 result = 0;
224 wimax_dev->rf_sw = state;
225 wimax_state = state == WIMAX_RF_ON ?
226 WIMAX_ST_READY : WIMAX_ST_RADIO_OFF;
227 __wimax_state_change(wimax_dev, wimax_state);
228 }
229out_no_change:
230 d_fnend(3, dev, "(wimax_dev %p state %u) = %d\n",
231 wimax_dev, state, result);
232 return result;
233}
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248static int wimax_rfkill_set_radio_block(void *data, bool blocked)
249{
250 int result;
251 struct wimax_dev *wimax_dev = data;
252 struct device *dev = wimax_dev_to_dev(wimax_dev);
253 enum wimax_rf_state rf_state;
254
255 d_fnstart(3, dev, "(wimax_dev %p blocked %u)\n", wimax_dev, blocked);
256 rf_state = WIMAX_RF_ON;
257 if (blocked)
258 rf_state = WIMAX_RF_OFF;
259 mutex_lock(&wimax_dev->mutex);
260 if (wimax_dev->state <= __WIMAX_ST_QUIESCING)
261 result = 0;
262 else
263 result = __wimax_rf_toggle_radio(wimax_dev, rf_state);
264 mutex_unlock(&wimax_dev->mutex);
265 d_fnend(3, dev, "(wimax_dev %p blocked %u) = %d\n",
266 wimax_dev, blocked, result);
267 return result;
268}
269
270static const struct rfkill_ops wimax_rfkill_ops = {
271 .set_block = wimax_rfkill_set_radio_block,
272};
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300int wimax_rfkill(struct wimax_dev *wimax_dev, enum wimax_rf_state state)
301{
302 int result;
303 struct device *dev = wimax_dev_to_dev(wimax_dev);
304
305 d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state);
306 mutex_lock(&wimax_dev->mutex);
307 result = wimax_dev_is_ready(wimax_dev);
308 if (result < 0) {
309
310
311
312
313 if (result == -ENOMEDIUM && state == WIMAX_RF_QUERY)
314 result = WIMAX_RF_OFF << 1 | WIMAX_RF_OFF;
315 goto error_not_ready;
316 }
317 switch (state) {
318 case WIMAX_RF_ON:
319 case WIMAX_RF_OFF:
320 result = __wimax_rf_toggle_radio(wimax_dev, state);
321 if (result < 0)
322 goto error;
323 rfkill_set_sw_state(wimax_dev->rfkill, state == WIMAX_RF_OFF);
324 break;
325 case WIMAX_RF_QUERY:
326 break;
327 default:
328 result = -EINVAL;
329 goto error;
330 }
331 result = wimax_dev->rf_sw << 1 | wimax_dev->rf_hw;
332error:
333error_not_ready:
334 mutex_unlock(&wimax_dev->mutex);
335 d_fnend(3, dev, "(wimax_dev %p state %u) = %d\n",
336 wimax_dev, state, result);
337 return result;
338}
339EXPORT_SYMBOL(wimax_rfkill);
340
341
342
343
344
345
346
347int wimax_rfkill_add(struct wimax_dev *wimax_dev)
348{
349 int result;
350 struct rfkill *rfkill;
351 struct device *dev = wimax_dev_to_dev(wimax_dev);
352
353 d_fnstart(3, dev, "(wimax_dev %p)\n", wimax_dev);
354
355 result = -ENOMEM;
356 rfkill = rfkill_alloc(wimax_dev->name, dev, RFKILL_TYPE_WIMAX,
357 &wimax_rfkill_ops, wimax_dev);
358 if (rfkill == NULL)
359 goto error_rfkill_allocate;
360
361 d_printf(1, dev, "rfkill %p\n", rfkill);
362
363 wimax_dev->rfkill = rfkill;
364
365 rfkill_init_sw_state(rfkill, 1);
366 result = rfkill_register(wimax_dev->rfkill);
367 if (result < 0)
368 goto error_rfkill_register;
369
370
371 if (wimax_dev->op_rfkill_sw_toggle == NULL)
372 wimax_dev->rf_sw = WIMAX_RF_ON;
373
374 d_fnend(3, dev, "(wimax_dev %p) = 0\n", wimax_dev);
375 return 0;
376
377error_rfkill_register:
378 rfkill_destroy(wimax_dev->rfkill);
379error_rfkill_allocate:
380 d_fnend(3, dev, "(wimax_dev %p) = %d\n", wimax_dev, result);
381 return result;
382}
383
384
385
386
387
388
389
390
391
392
393void wimax_rfkill_rm(struct wimax_dev *wimax_dev)
394{
395 struct device *dev = wimax_dev_to_dev(wimax_dev);
396 d_fnstart(3, dev, "(wimax_dev %p)\n", wimax_dev);
397 rfkill_unregister(wimax_dev->rfkill);
398 rfkill_destroy(wimax_dev->rfkill);
399 d_fnend(3, dev, "(wimax_dev %p)\n", wimax_dev);
400}
401
402
403
404
405
406
407
408
409
410
411
412
413int wimax_gnl_doit_rfkill(struct sk_buff *skb, struct genl_info *info)
414{
415 int result, ifindex;
416 struct wimax_dev *wimax_dev;
417 struct device *dev;
418 enum wimax_rf_state new_state;
419
420 d_fnstart(3, NULL, "(skb %p info %p)\n", skb, info);
421 result = -ENODEV;
422 if (info->attrs[WIMAX_GNL_RFKILL_IFIDX] == NULL) {
423 pr_err("WIMAX_GNL_OP_RFKILL: can't find IFIDX attribute\n");
424 goto error_no_wimax_dev;
425 }
426 ifindex = nla_get_u32(info->attrs[WIMAX_GNL_RFKILL_IFIDX]);
427 wimax_dev = wimax_dev_get_by_genl_info(info, ifindex);
428 if (wimax_dev == NULL)
429 goto error_no_wimax_dev;
430 dev = wimax_dev_to_dev(wimax_dev);
431 result = -EINVAL;
432 if (info->attrs[WIMAX_GNL_RFKILL_STATE] == NULL) {
433 dev_err(dev, "WIMAX_GNL_RFKILL: can't find RFKILL_STATE "
434 "attribute\n");
435 goto error_no_pid;
436 }
437 new_state = nla_get_u32(info->attrs[WIMAX_GNL_RFKILL_STATE]);
438
439
440 result = wimax_rfkill(wimax_dev, new_state);
441error_no_pid:
442 dev_put(wimax_dev->net_dev);
443error_no_wimax_dev:
444 d_fnend(3, NULL, "(skb %p info %p) = %d\n", skb, info, result);
445 return result;
446}
447