This source file includes following definitions.
- wimax_gnl_re_state_change_alloc
- wimax_gnl_re_state_change_send
- __check_new_state
- __wimax_state_change
- wimax_state_change
- wimax_state_get
- wimax_dev_init
- wimax_addr_scnprint
- wimax_dev_add
- wimax_dev_rm
- wimax_subsys_init
- wimax_subsys_exit
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 #include <linux/device.h>
39 #include <linux/gfp.h>
40 #include <net/genetlink.h>
41 #include <linux/netdevice.h>
42 #include <linux/wimax.h>
43 #include <linux/module.h>
44 #include "wimax-internal.h"
45
46
47 #define D_SUBMODULE stack
48 #include "debug-levels.h"
49
50 static char wimax_debug_params[128];
51 module_param_string(debug, wimax_debug_params, sizeof(wimax_debug_params),
52 0644);
53 MODULE_PARM_DESC(debug,
54 "String of space-separated NAME:VALUE pairs, where NAMEs "
55 "are the different debug submodules and VALUE are the "
56 "initial debug value to set.");
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85 static
86 struct sk_buff *wimax_gnl_re_state_change_alloc(
87 struct wimax_dev *wimax_dev,
88 enum wimax_st new_state, enum wimax_st old_state,
89 void **header)
90 {
91 int result;
92 struct device *dev = wimax_dev_to_dev(wimax_dev);
93 void *data;
94 struct sk_buff *report_skb;
95
96 d_fnstart(3, dev, "(wimax_dev %p new_state %u old_state %u)\n",
97 wimax_dev, new_state, old_state);
98 result = -ENOMEM;
99 report_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
100 if (report_skb == NULL) {
101 dev_err(dev, "RE_STCH: can't create message\n");
102 goto error_new;
103 }
104
105 data = genlmsg_put(report_skb, 0, wimax_gnl_family.mcgrp_offset,
106 &wimax_gnl_family, 0, WIMAX_GNL_RE_STATE_CHANGE);
107 if (data == NULL) {
108 dev_err(dev, "RE_STCH: can't put data into message\n");
109 goto error_put;
110 }
111 *header = data;
112
113 result = nla_put_u8(report_skb, WIMAX_GNL_STCH_STATE_OLD, old_state);
114 if (result < 0) {
115 dev_err(dev, "RE_STCH: Error adding OLD attr: %d\n", result);
116 goto error_put;
117 }
118 result = nla_put_u8(report_skb, WIMAX_GNL_STCH_STATE_NEW, new_state);
119 if (result < 0) {
120 dev_err(dev, "RE_STCH: Error adding NEW attr: %d\n", result);
121 goto error_put;
122 }
123 result = nla_put_u32(report_skb, WIMAX_GNL_STCH_IFIDX,
124 wimax_dev->net_dev->ifindex);
125 if (result < 0) {
126 dev_err(dev, "RE_STCH: Error adding IFINDEX attribute\n");
127 goto error_put;
128 }
129 d_fnend(3, dev, "(wimax_dev %p new_state %u old_state %u) = %p\n",
130 wimax_dev, new_state, old_state, report_skb);
131 return report_skb;
132
133 error_put:
134 nlmsg_free(report_skb);
135 error_new:
136 d_fnend(3, dev, "(wimax_dev %p new_state %u old_state %u) = %d\n",
137 wimax_dev, new_state, old_state, result);
138 return ERR_PTR(result);
139 }
140
141
142
143
144
145
146
147
148
149
150
151
152 static
153 int wimax_gnl_re_state_change_send(
154 struct wimax_dev *wimax_dev, struct sk_buff *report_skb,
155 void *header)
156 {
157 int result = 0;
158 struct device *dev = wimax_dev_to_dev(wimax_dev);
159 d_fnstart(3, dev, "(wimax_dev %p report_skb %p)\n",
160 wimax_dev, report_skb);
161 if (report_skb == NULL) {
162 result = -ENOMEM;
163 goto out;
164 }
165 genlmsg_end(report_skb, header);
166 genlmsg_multicast(&wimax_gnl_family, report_skb, 0, 0, GFP_KERNEL);
167 out:
168 d_fnend(3, dev, "(wimax_dev %p report_skb %p) = %d\n",
169 wimax_dev, report_skb, result);
170 return result;
171 }
172
173
174 static
175 void __check_new_state(enum wimax_st old_state, enum wimax_st new_state,
176 unsigned int allowed_states_bm)
177 {
178 if (WARN_ON(((1 << new_state) & allowed_states_bm) == 0)) {
179 pr_err("SW BUG! Forbidden state change %u -> %u\n",
180 old_state, new_state);
181 }
182 }
183
184
185
186
187
188
189 void __wimax_state_change(struct wimax_dev *wimax_dev, enum wimax_st new_state)
190 {
191 struct device *dev = wimax_dev_to_dev(wimax_dev);
192 enum wimax_st old_state = wimax_dev->state;
193 struct sk_buff *stch_skb;
194 void *header;
195
196 d_fnstart(3, dev, "(wimax_dev %p new_state %u [old %u])\n",
197 wimax_dev, new_state, old_state);
198
199 if (WARN_ON(new_state >= __WIMAX_ST_INVALID)) {
200 dev_err(dev, "SW BUG: requesting invalid state %u\n",
201 new_state);
202 goto out;
203 }
204 if (old_state == new_state)
205 goto out;
206 header = NULL;
207 stch_skb = wimax_gnl_re_state_change_alloc(
208 wimax_dev, new_state, old_state, &header);
209
210
211 switch (old_state) {
212 case __WIMAX_ST_NULL:
213 __check_new_state(old_state, new_state,
214 1 << WIMAX_ST_DOWN);
215 break;
216 case WIMAX_ST_DOWN:
217 __check_new_state(old_state, new_state,
218 1 << __WIMAX_ST_QUIESCING
219 | 1 << WIMAX_ST_UNINITIALIZED
220 | 1 << WIMAX_ST_RADIO_OFF);
221 break;
222 case __WIMAX_ST_QUIESCING:
223 __check_new_state(old_state, new_state, 1 << WIMAX_ST_DOWN);
224 break;
225 case WIMAX_ST_UNINITIALIZED:
226 __check_new_state(old_state, new_state,
227 1 << __WIMAX_ST_QUIESCING
228 | 1 << WIMAX_ST_RADIO_OFF);
229 break;
230 case WIMAX_ST_RADIO_OFF:
231 __check_new_state(old_state, new_state,
232 1 << __WIMAX_ST_QUIESCING
233 | 1 << WIMAX_ST_READY);
234 break;
235 case WIMAX_ST_READY:
236 __check_new_state(old_state, new_state,
237 1 << __WIMAX_ST_QUIESCING
238 | 1 << WIMAX_ST_RADIO_OFF
239 | 1 << WIMAX_ST_SCANNING
240 | 1 << WIMAX_ST_CONNECTING
241 | 1 << WIMAX_ST_CONNECTED);
242 break;
243 case WIMAX_ST_SCANNING:
244 __check_new_state(old_state, new_state,
245 1 << __WIMAX_ST_QUIESCING
246 | 1 << WIMAX_ST_RADIO_OFF
247 | 1 << WIMAX_ST_READY
248 | 1 << WIMAX_ST_CONNECTING
249 | 1 << WIMAX_ST_CONNECTED);
250 break;
251 case WIMAX_ST_CONNECTING:
252 __check_new_state(old_state, new_state,
253 1 << __WIMAX_ST_QUIESCING
254 | 1 << WIMAX_ST_RADIO_OFF
255 | 1 << WIMAX_ST_READY
256 | 1 << WIMAX_ST_SCANNING
257 | 1 << WIMAX_ST_CONNECTED);
258 break;
259 case WIMAX_ST_CONNECTED:
260 __check_new_state(old_state, new_state,
261 1 << __WIMAX_ST_QUIESCING
262 | 1 << WIMAX_ST_RADIO_OFF
263 | 1 << WIMAX_ST_READY);
264 netif_tx_disable(wimax_dev->net_dev);
265 netif_carrier_off(wimax_dev->net_dev);
266 break;
267 case __WIMAX_ST_INVALID:
268 default:
269 dev_err(dev, "SW BUG: wimax_dev %p is in unknown state %u\n",
270 wimax_dev, wimax_dev->state);
271 WARN_ON(1);
272 goto out;
273 }
274
275
276 switch (new_state) {
277 case __WIMAX_ST_NULL:
278 dev_err(dev, "SW BUG: wimax_dev %p entering NULL state "
279 "from %u\n", wimax_dev, wimax_dev->state);
280 WARN_ON(1);
281 break;
282 case WIMAX_ST_DOWN:
283 break;
284 case __WIMAX_ST_QUIESCING:
285 break;
286 case WIMAX_ST_UNINITIALIZED:
287 break;
288 case WIMAX_ST_RADIO_OFF:
289 break;
290 case WIMAX_ST_READY:
291 break;
292 case WIMAX_ST_SCANNING:
293 break;
294 case WIMAX_ST_CONNECTING:
295 break;
296 case WIMAX_ST_CONNECTED:
297 netif_carrier_on(wimax_dev->net_dev);
298 netif_wake_queue(wimax_dev->net_dev);
299 break;
300 case __WIMAX_ST_INVALID:
301 default:
302 BUG();
303 }
304 __wimax_state_set(wimax_dev, new_state);
305 if (!IS_ERR(stch_skb))
306 wimax_gnl_re_state_change_send(wimax_dev, stch_skb, header);
307 out:
308 d_fnend(3, dev, "(wimax_dev %p new_state %u [old %u]) = void\n",
309 wimax_dev, new_state, old_state);
310 }
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333 void wimax_state_change(struct wimax_dev *wimax_dev, enum wimax_st new_state)
334 {
335
336
337
338
339
340
341
342
343
344
345
346
347 mutex_lock(&wimax_dev->mutex);
348 if (wimax_dev->state > __WIMAX_ST_NULL)
349 __wimax_state_change(wimax_dev, new_state);
350 mutex_unlock(&wimax_dev->mutex);
351 }
352 EXPORT_SYMBOL_GPL(wimax_state_change);
353
354
355
356
357
358
359
360
361
362 enum wimax_st wimax_state_get(struct wimax_dev *wimax_dev)
363 {
364 enum wimax_st state;
365 mutex_lock(&wimax_dev->mutex);
366 state = wimax_dev->state;
367 mutex_unlock(&wimax_dev->mutex);
368 return state;
369 }
370 EXPORT_SYMBOL_GPL(wimax_state_get);
371
372
373
374
375
376
377
378
379
380
381
382 void wimax_dev_init(struct wimax_dev *wimax_dev)
383 {
384 INIT_LIST_HEAD(&wimax_dev->id_table_node);
385 __wimax_state_set(wimax_dev, __WIMAX_ST_NULL);
386 mutex_init(&wimax_dev->mutex);
387 mutex_init(&wimax_dev->mutex_reset);
388 }
389 EXPORT_SYMBOL_GPL(wimax_dev_init);
390
391 static const struct nla_policy wimax_gnl_policy[WIMAX_GNL_ATTR_MAX + 1] = {
392 [WIMAX_GNL_RESET_IFIDX] = { .type = NLA_U32, },
393 [WIMAX_GNL_RFKILL_IFIDX] = { .type = NLA_U32, },
394 [WIMAX_GNL_RFKILL_STATE] = {
395 .type = NLA_U32
396 },
397 [WIMAX_GNL_STGET_IFIDX] = { .type = NLA_U32, },
398 [WIMAX_GNL_MSG_IFIDX] = { .type = NLA_U32, },
399 [WIMAX_GNL_MSG_DATA] = {
400 .type = NLA_UNSPEC,
401 },
402 };
403
404 static const struct genl_ops wimax_gnl_ops[] = {
405 {
406 .cmd = WIMAX_GNL_OP_MSG_FROM_USER,
407 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
408 .flags = GENL_ADMIN_PERM,
409 .doit = wimax_gnl_doit_msg_from_user,
410 },
411 {
412 .cmd = WIMAX_GNL_OP_RESET,
413 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
414 .flags = GENL_ADMIN_PERM,
415 .doit = wimax_gnl_doit_reset,
416 },
417 {
418 .cmd = WIMAX_GNL_OP_RFKILL,
419 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
420 .flags = GENL_ADMIN_PERM,
421 .doit = wimax_gnl_doit_rfkill,
422 },
423 {
424 .cmd = WIMAX_GNL_OP_STATE_GET,
425 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
426 .flags = GENL_ADMIN_PERM,
427 .doit = wimax_gnl_doit_state_get,
428 },
429 };
430
431
432 static
433 size_t wimax_addr_scnprint(char *addr_str, size_t addr_str_size,
434 unsigned char *addr, size_t addr_len)
435 {
436 unsigned int cnt, total;
437
438 for (total = cnt = 0; cnt < addr_len; cnt++)
439 total += scnprintf(addr_str + total, addr_str_size - total,
440 "%02x%c", addr[cnt],
441 cnt == addr_len - 1 ? '\0' : ':');
442 return total;
443 }
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465 int wimax_dev_add(struct wimax_dev *wimax_dev, struct net_device *net_dev)
466 {
467 int result;
468 struct device *dev = net_dev->dev.parent;
469 char addr_str[32];
470
471 d_fnstart(3, dev, "(wimax_dev %p net_dev %p)\n", wimax_dev, net_dev);
472
473
474
475
476 wimax_dev->net_dev = net_dev;
477 result = wimax_rfkill_add(wimax_dev);
478 if (result < 0)
479 goto error_rfkill_add;
480
481
482 mutex_lock(&wimax_dev->mutex);
483 wimax_id_table_add(wimax_dev);
484 wimax_debugfs_add(wimax_dev);
485
486 __wimax_state_set(wimax_dev, WIMAX_ST_DOWN);
487 mutex_unlock(&wimax_dev->mutex);
488
489 wimax_addr_scnprint(addr_str, sizeof(addr_str),
490 net_dev->dev_addr, net_dev->addr_len);
491 dev_err(dev, "WiMAX interface %s (%s) ready\n",
492 net_dev->name, addr_str);
493 d_fnend(3, dev, "(wimax_dev %p net_dev %p) = 0\n", wimax_dev, net_dev);
494 return 0;
495
496 error_rfkill_add:
497 d_fnend(3, dev, "(wimax_dev %p net_dev %p) = %d\n",
498 wimax_dev, net_dev, result);
499 return result;
500 }
501 EXPORT_SYMBOL_GPL(wimax_dev_add);
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523 void wimax_dev_rm(struct wimax_dev *wimax_dev)
524 {
525 d_fnstart(3, NULL, "(wimax_dev %p)\n", wimax_dev);
526
527 mutex_lock(&wimax_dev->mutex);
528 __wimax_state_change(wimax_dev, __WIMAX_ST_QUIESCING);
529 wimax_debugfs_rm(wimax_dev);
530 wimax_id_table_rm(wimax_dev);
531 __wimax_state_change(wimax_dev, WIMAX_ST_DOWN);
532 mutex_unlock(&wimax_dev->mutex);
533 wimax_rfkill_rm(wimax_dev);
534 d_fnend(3, NULL, "(wimax_dev %p) = void\n", wimax_dev);
535 }
536 EXPORT_SYMBOL_GPL(wimax_dev_rm);
537
538
539
540 struct d_level D_LEVEL[] = {
541 D_SUBMODULE_DEFINE(debugfs),
542 D_SUBMODULE_DEFINE(id_table),
543 D_SUBMODULE_DEFINE(op_msg),
544 D_SUBMODULE_DEFINE(op_reset),
545 D_SUBMODULE_DEFINE(op_rfkill),
546 D_SUBMODULE_DEFINE(op_state_get),
547 D_SUBMODULE_DEFINE(stack),
548 };
549 size_t D_LEVEL_SIZE = ARRAY_SIZE(D_LEVEL);
550
551
552 static const struct genl_multicast_group wimax_gnl_mcgrps[] = {
553 { .name = "msg", },
554 };
555
556 struct genl_family wimax_gnl_family __ro_after_init = {
557 .name = "WiMAX",
558 .version = WIMAX_GNL_VERSION,
559 .hdrsize = 0,
560 .maxattr = WIMAX_GNL_ATTR_MAX,
561 .policy = wimax_gnl_policy,
562 .module = THIS_MODULE,
563 .ops = wimax_gnl_ops,
564 .n_ops = ARRAY_SIZE(wimax_gnl_ops),
565 .mcgrps = wimax_gnl_mcgrps,
566 .n_mcgrps = ARRAY_SIZE(wimax_gnl_mcgrps),
567 };
568
569
570
571
572 static
573 int __init wimax_subsys_init(void)
574 {
575 int result;
576
577 d_fnstart(4, NULL, "()\n");
578 d_parse_params(D_LEVEL, D_LEVEL_SIZE, wimax_debug_params,
579 "wimax.debug");
580
581 result = genl_register_family(&wimax_gnl_family);
582 if (unlikely(result < 0)) {
583 pr_err("cannot register generic netlink family: %d\n", result);
584 goto error_register_family;
585 }
586
587 d_fnend(4, NULL, "() = 0\n");
588 return 0;
589
590 error_register_family:
591 d_fnend(4, NULL, "() = %d\n", result);
592 return result;
593
594 }
595 module_init(wimax_subsys_init);
596
597
598
599 static
600 void __exit wimax_subsys_exit(void)
601 {
602 wimax_id_table_release();
603 genl_unregister_family(&wimax_gnl_family);
604 }
605 module_exit(wimax_subsys_exit);
606
607 MODULE_AUTHOR("Intel Corporation <linux-wimax@intel.com>");
608 MODULE_DESCRIPTION("Linux WiMAX stack");
609 MODULE_LICENSE("GPL");