iwinfo: clean up rpc_iwinfo_call_hw_ht_mode()
[project/rpcd.git] / iwinfo.c
1 /*
2 * rpcd - UBUS RPC server
3 *
4 * Copyright (C) 2013-2014 Jo-Philipp Wich <jow@openwrt.org>
5 *
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
9 *
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 */
18
19 #include <sys/types.h>
20 #include <ctype.h>
21 #include <dirent.h>
22 #include <libubus.h>
23 #include <iwinfo.h>
24 #include <iwinfo/utils.h>
25 #include <net/ethernet.h>
26
27 #ifdef linux
28 #include <netinet/ether.h>
29 #endif
30
31 #include <rpcd/plugin.h>
32
33
34 static struct blob_buf buf;
35 static const struct iwinfo_ops *iw;
36 static const char *ifname;
37
38 enum {
39 RPC_D_DEVICE,
40 __RPC_D_MAX,
41 };
42
43 static const struct blobmsg_policy rpc_device_policy[__RPC_D_MAX] = {
44 [RPC_D_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
45 };
46
47 enum {
48 RPC_A_DEVICE,
49 RPC_A_MACADDR,
50 __RPC_A_MAX,
51 };
52
53 static const struct blobmsg_policy rpc_assoclist_policy[__RPC_A_MAX] = {
54 [RPC_A_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
55 [RPC_A_MACADDR] = { .name = "mac", .type = BLOBMSG_TYPE_STRING },
56 };
57
58 enum {
59 RPC_U_SECTION,
60 __RPC_U_MAX
61 };
62
63 static const struct blobmsg_policy rpc_uci_policy[__RPC_U_MAX] = {
64 [RPC_U_SECTION] = { .name = "section", .type = BLOBMSG_TYPE_STRING },
65 };
66
67 static int
68 __rpc_iwinfo_open(struct blob_attr *device)
69 {
70 if (!device)
71 return UBUS_STATUS_INVALID_ARGUMENT;
72
73 ifname = blobmsg_data(device);
74 iw = iwinfo_backend(ifname);
75
76 return iw ? UBUS_STATUS_OK : UBUS_STATUS_NOT_FOUND;
77 }
78
79 static int
80 rpc_iwinfo_open(struct blob_attr *msg)
81 {
82 static struct blob_attr *tb[__RPC_D_MAX];
83
84 blobmsg_parse(rpc_device_policy, __RPC_D_MAX, tb,
85 blob_data(msg), blob_len(msg));
86
87 return __rpc_iwinfo_open(tb[RPC_D_DEVICE]);
88 }
89
90 static void
91 rpc_iwinfo_close(void)
92 {
93 iw = NULL;
94 ifname = NULL;
95 iwinfo_finish();
96 }
97
98 static void
99 rpc_iwinfo_call_int(const char *name, int (*func)(const char *, int *),
100 const char * const *map)
101 {
102 int rv;
103
104 if (!func(ifname, &rv))
105 {
106 if (!map)
107 blobmsg_add_u32(&buf, name, rv);
108 else
109 blobmsg_add_string(&buf, name, map[rv]);
110 }
111 }
112
113 static void
114 rpc_iwinfo_call_hardware_id(const char *name)
115 {
116 struct iwinfo_hardware_id ids;
117 void *c;
118
119 if (!iw->hardware_id(ifname, (char *)&ids))
120 {
121 c = blobmsg_open_array(&buf, name);
122
123 blobmsg_add_u32(&buf, NULL, ids.vendor_id);
124 blobmsg_add_u32(&buf, NULL, ids.device_id);
125 blobmsg_add_u32(&buf, NULL, ids.subsystem_vendor_id);
126 blobmsg_add_u32(&buf, NULL, ids.subsystem_device_id);
127
128 blobmsg_close_array(&buf, c);
129 }
130 }
131
132 static void
133 rpc_iwinfo_lower(const char *src, char *dst, size_t len)
134 {
135 size_t i;
136
137 for (i = 0; *src && i < len; i++)
138 *dst++ = tolower(*src++);
139
140 *dst = 0;
141 }
142
143 static void
144 rpc_iwinfo_add_bit_array(const char *name, uint32_t bits,
145 const char * const values[], size_t len,
146 bool lower, uint32_t zero)
147 {
148 void *c;
149 size_t i;
150 char l[128];
151 const char *v;
152
153 if (!bits)
154 bits = zero;
155
156 c = blobmsg_open_array(&buf, name);
157
158 for (i = 0; i < len; i++)
159 if (bits & 1 << i)
160 {
161 v = values[i];
162
163 if (lower)
164 {
165 rpc_iwinfo_lower(v, l, strlen(values[i]));
166 v = l;
167 }
168
169 blobmsg_add_string(&buf, NULL, v);
170 }
171
172 blobmsg_close_array(&buf, c);
173 }
174
175 static void
176 rpc_iwinfo_add_encryption(const char *name, struct iwinfo_crypto_entry *e)
177 {
178 int wpa_version;
179 void *c, *d;
180
181 c = blobmsg_open_table(&buf, name);
182
183 blobmsg_add_u8(&buf, "enabled", e->enabled);
184
185 if (e->enabled)
186 {
187 if (!e->wpa_version)
188 {
189 rpc_iwinfo_add_bit_array("wep", e->auth_algs,
190 IWINFO_AUTH_NAMES,
191 IWINFO_AUTH_COUNT,
192 true, 0);
193 }
194 else
195 {
196 d = blobmsg_open_array(&buf, "wpa");
197
198 for (wpa_version = 1; wpa_version <= 3; wpa_version++)
199 if (e->wpa_version & (1 << (wpa_version - 1)))
200 blobmsg_add_u32(&buf, NULL, wpa_version);
201
202 blobmsg_close_array(&buf, d);
203
204 rpc_iwinfo_add_bit_array("authentication",
205 e->auth_suites,
206 IWINFO_KMGMT_NAMES,
207 IWINFO_KMGMT_COUNT,
208 true, IWINFO_KMGMT_NONE);
209 }
210
211
212 rpc_iwinfo_add_bit_array("ciphers",
213 e->pair_ciphers | e->group_ciphers,
214 IWINFO_CIPHER_NAMES,
215 IWINFO_CIPHER_COUNT,
216 true, IWINFO_CIPHER_NONE);
217 }
218
219 blobmsg_close_table(&buf, c);
220 }
221
222 static void
223 rpc_iwinfo_call_encryption(const char *name)
224 {
225 struct iwinfo_crypto_entry crypto = { 0 };
226
227 if (!iw->encryption(ifname, (char *)&crypto))
228 rpc_iwinfo_add_encryption(name, &crypto);
229 }
230
231 static void
232 rpc_iwinfo_call_htmodes(const char *name)
233 {
234 int modes;
235
236 if (iw->htmodelist(ifname, &modes))
237 return;
238
239 rpc_iwinfo_add_bit_array(name, modes & ~IWINFO_HTMODE_NOHT,
240 IWINFO_HTMODE_NAMES, IWINFO_HTMODE_COUNT,
241 false, 0);
242 }
243
244 static int
245 rpc_iwinfo_call_hwmodes(const char *name)
246 {
247 int modes;
248
249 if (iw->hwmodelist(ifname, &modes))
250 return -1;
251
252 rpc_iwinfo_add_bit_array(name, modes,
253 IWINFO_80211_NAMES, IWINFO_80211_COUNT,
254 false, 0);
255
256 return modes;
257 }
258
259 static void rpc_iwinfo_call_hw_ht_mode(int hwmodelist)
260 {
261 const char *hwmode_str;
262 const char *htmode_str;
263 int htmode;
264
265 if (hwmodelist == IWINFO_80211_AD)
266 {
267 blobmsg_add_string(&buf, "hwmode", "ad");
268 return;
269 }
270
271 if (iw->htmode(ifname, &htmode))
272 return;
273
274 htmode_str = iwinfo_htmode_name(htmode);
275 if (htmode_str)
276 {
277 if (iwinfo_htmode_is_ht(htmode))
278 hwmode_str = "n";
279 else if (iwinfo_htmode_is_vht(htmode))
280 hwmode_str = "ac";
281 else if (iwinfo_htmode_is_he(htmode))
282 hwmode_str = "ax";
283 else
284 hwmode_str = "a/g";
285 } else
286 htmode_str = hwmode_str = "unknown";
287
288 blobmsg_add_string(&buf, "hwmode", hwmode_str);
289 blobmsg_add_string(&buf, "htmode", htmode_str);
290 }
291
292 static void
293 rpc_iwinfo_call_str(const char *name, int (*func)(const char *, char *))
294 {
295 char rv[IWINFO_BUFSIZE] = { 0 };
296
297 if (!func(ifname, rv))
298 blobmsg_add_string(&buf, name, rv);
299 }
300
301 static int
302 rpc_iwinfo_info(struct ubus_context *ctx, struct ubus_object *obj,
303 struct ubus_request_data *req, const char *method,
304 struct blob_attr *msg)
305 {
306 int rv, hwmodes;
307 void *c;
308
309 rv = rpc_iwinfo_open(msg);
310
311 if (rv)
312 return rv;
313
314 blob_buf_init(&buf, 0);
315
316 rpc_iwinfo_call_str("phy", iw->phyname);
317
318 rpc_iwinfo_call_str("ssid", iw->ssid);
319 rpc_iwinfo_call_str("bssid", iw->bssid);
320 rpc_iwinfo_call_str("country", iw->country);
321
322 rpc_iwinfo_call_int("mode", iw->mode, IWINFO_OPMODE_NAMES);
323 rpc_iwinfo_call_int("channel", iw->channel, NULL);
324 rpc_iwinfo_call_int("center_chan1", iw->center_chan1, NULL);
325 rpc_iwinfo_call_int("center_chan2", iw->center_chan2, NULL);
326
327 rpc_iwinfo_call_int("frequency", iw->frequency, NULL);
328 rpc_iwinfo_call_int("frequency_offset", iw->frequency_offset, NULL);
329
330 rpc_iwinfo_call_int("txpower", iw->txpower, NULL);
331 rpc_iwinfo_call_int("txpower_offset", iw->txpower_offset, NULL);
332
333 rpc_iwinfo_call_int("quality", iw->quality, NULL);
334 rpc_iwinfo_call_int("quality_max", iw->quality_max, NULL);
335
336 rpc_iwinfo_call_int("signal", iw->signal, NULL);
337 rpc_iwinfo_call_int("noise", iw->noise, NULL);
338
339 rpc_iwinfo_call_int("bitrate", iw->bitrate, NULL);
340
341 rpc_iwinfo_call_encryption("encryption");
342 rpc_iwinfo_call_htmodes("htmodes");
343 hwmodes = rpc_iwinfo_call_hwmodes("hwmodes");
344
345 if (hwmodes > 0)
346 rpc_iwinfo_call_hw_ht_mode(hwmodes);
347
348 c = blobmsg_open_table(&buf, "hardware");
349 rpc_iwinfo_call_hardware_id("id");
350 rpc_iwinfo_call_str("name", iw->hardware_name);
351 blobmsg_close_table(&buf, c);
352
353 ubus_send_reply(ctx, req, buf.head);
354
355 rpc_iwinfo_close();
356
357 return UBUS_STATUS_OK;
358 }
359
360 static int
361 rpc_iwinfo_scan(struct ubus_context *ctx, struct ubus_object *obj,
362 struct ubus_request_data *req, const char *method,
363 struct blob_attr *msg)
364 {
365 int i, rv, len;
366 void *c, *d, *t;
367 char mac[18];
368 char res[IWINFO_BUFSIZE];
369 struct iwinfo_scanlist_entry *e;
370
371 rv = rpc_iwinfo_open(msg);
372
373 if (rv)
374 return rv;
375
376 blob_buf_init(&buf, 0);
377
378 c = blobmsg_open_array(&buf, "results");
379
380 if (!iw->scanlist(ifname, res, &len) && (len > 0))
381 {
382 for (i = 0; i < len; i += sizeof(struct iwinfo_scanlist_entry))
383 {
384 e = (struct iwinfo_scanlist_entry *)&res[i];
385 d = blobmsg_open_table(&buf, NULL);
386
387 if (e->ssid[0])
388 blobmsg_add_string(&buf, "ssid", (const char *)e->ssid);
389
390 snprintf(mac, sizeof(mac), "%02X:%02X:%02X:%02X:%02X:%02X",
391 e->mac[0], e->mac[1], e->mac[2],
392 e->mac[3], e->mac[4], e->mac[5]);
393
394 blobmsg_add_string(&buf, "bssid", mac);
395
396 blobmsg_add_string(&buf, "mode", IWINFO_OPMODE_NAMES[e->mode]);
397
398 blobmsg_add_u32(&buf, "channel", e->channel);
399 blobmsg_add_u32(&buf, "signal", (uint32_t)(e->signal - 0x100));
400
401 blobmsg_add_u32(&buf, "quality", e->quality);
402 blobmsg_add_u32(&buf, "quality_max", e->quality_max);
403
404 if (e->ht_chan_info.primary_chan) {
405 t = blobmsg_open_table(&buf, "ht_operation");
406 blobmsg_add_u32(&buf, "primary_channel", e->ht_chan_info.primary_chan);
407 blobmsg_add_string(&buf, "secondary_channel_offset", ht_secondary_offset[e->ht_chan_info.secondary_chan_off]);
408 blobmsg_add_u32(&buf, "channel_width", ht_chan_width[e->ht_chan_info.chan_width]);
409 blobmsg_close_table(&buf, t);
410 }
411
412 if (e->vht_chan_info.center_chan_1) {
413 t = blobmsg_open_table(&buf, "vht_operation");
414 blobmsg_add_u32(&buf, "channel_width", vht_chan_width[e->vht_chan_info.chan_width]);
415 blobmsg_add_u32(&buf, "center_freq_1", e->vht_chan_info.center_chan_1);
416 blobmsg_add_u32(&buf, "center_freq_2", e->vht_chan_info.center_chan_2);
417 blobmsg_close_table(&buf, t);
418 }
419
420 rpc_iwinfo_add_encryption("encryption", &e->crypto);
421
422 blobmsg_close_table(&buf, d);
423 }
424 }
425
426 blobmsg_close_array(&buf, c);
427
428 ubus_send_reply(ctx, req, buf.head);
429
430 rpc_iwinfo_close();
431
432 return UBUS_STATUS_OK;
433 }
434
435 static void
436 rpc_iwinfo_add_rateinfo(struct iwinfo_rate_entry *r)
437 {
438 blobmsg_add_u8(&buf, "ht", r->is_ht);
439 blobmsg_add_u8(&buf, "vht", r->is_vht);
440 blobmsg_add_u8(&buf, "he", r->is_he);
441 blobmsg_add_u32(&buf, "mhz", r->mhz);
442 blobmsg_add_u32(&buf, "rate", r->rate);
443
444 if (r->is_ht) {
445 blobmsg_add_u32(&buf, "mcs", r->mcs);
446 blobmsg_add_u8(&buf, "40mhz", r->is_40mhz);
447 blobmsg_add_u8(&buf, "short_gi", r->is_short_gi);
448 }
449 else if (r->is_vht) {
450 blobmsg_add_u32(&buf, "mcs", r->mcs);
451 blobmsg_add_u32(&buf, "nss", r->nss);
452 blobmsg_add_u8(&buf, "short_gi", r->is_short_gi);
453 }
454 else if (r->is_he) {
455 blobmsg_add_u32(&buf, "mcs", r->mcs);
456 blobmsg_add_u32(&buf, "nss", r->nss);
457 blobmsg_add_u32(&buf, "he_gi", r->he_gi);
458 blobmsg_add_u32(&buf, "he_dcm", r->he_dcm);
459 }
460 }
461
462 static int
463 rpc_iwinfo_assoclist(struct ubus_context *ctx, struct ubus_object *obj,
464 struct ubus_request_data *req, const char *method,
465 struct blob_attr *msg)
466 {
467 int i, rv, len;
468 char mac[18];
469 char res[IWINFO_BUFSIZE];
470 struct iwinfo_assoclist_entry *a;
471 struct ether_addr *macaddr = NULL;
472 void *c = NULL, *d, *e;
473 struct blob_attr *tb[__RPC_A_MAX];
474 bool found = false;
475
476 blobmsg_parse(rpc_assoclist_policy, __RPC_A_MAX, tb,
477 blob_data(msg), blob_len(msg));
478
479 rv = __rpc_iwinfo_open(tb[RPC_A_DEVICE]);
480 if (rv)
481 return rv;
482
483 if (tb[RPC_A_MACADDR])
484 macaddr = ether_aton(blobmsg_data(tb[RPC_A_MACADDR]));
485
486 blob_buf_init(&buf, 0);
487
488 if (!macaddr)
489 c = blobmsg_open_array(&buf, "results");
490
491 if (!iw->assoclist(ifname, res, &len) && (len > 0))
492 {
493 for (i = 0; i < len; i += sizeof(struct iwinfo_assoclist_entry))
494 {
495 a = (struct iwinfo_assoclist_entry *)&res[i];
496
497 if (!macaddr)
498 d = blobmsg_open_table(&buf, NULL);
499 else if (memcmp(macaddr, a->mac, ETH_ALEN) != 0)
500 continue;
501
502 snprintf(mac, sizeof(mac), "%02X:%02X:%02X:%02X:%02X:%02X",
503 a->mac[0], a->mac[1], a->mac[2],
504 a->mac[3], a->mac[4], a->mac[5]);
505
506 blobmsg_add_string(&buf, "mac", mac);
507 blobmsg_add_u32(&buf, "signal", a->signal);
508 blobmsg_add_u32(&buf, "signal_avg", a->signal_avg);
509 blobmsg_add_u32(&buf, "noise", a->noise);
510 blobmsg_add_u32(&buf, "inactive", a->inactive);
511 blobmsg_add_u32(&buf, "connected_time", a->connected_time);
512 blobmsg_add_u32(&buf, "thr", a->thr);
513 blobmsg_add_u8(&buf, "authorized", a->is_authorized);
514 blobmsg_add_u8(&buf, "authenticated", a->is_authenticated);
515 blobmsg_add_string(&buf, "preamble", a->is_preamble_short ? "short" : "long");
516 blobmsg_add_u8(&buf, "wme", a->is_wme);
517 blobmsg_add_u8(&buf, "mfp", a->is_mfp);
518 blobmsg_add_u8(&buf, "tdls", a->is_tdls);
519
520 blobmsg_add_u16(&buf, "mesh llid", a->llid);
521 blobmsg_add_u16(&buf, "mesh plid", a->plid);
522 blobmsg_add_string(&buf, "mesh plink", a->plink_state);
523 blobmsg_add_string(&buf, "mesh local PS", a->local_ps);
524 blobmsg_add_string(&buf, "mesh peer PS", a->peer_ps);
525 blobmsg_add_string(&buf, "mesh non-peer PS", a->nonpeer_ps);
526
527 e = blobmsg_open_table(&buf, "rx");
528 blobmsg_add_u64(&buf, "drop_misc", a->rx_drop_misc);
529 blobmsg_add_u32(&buf, "packets", a->rx_packets);
530 blobmsg_add_u32(&buf, "bytes", a->rx_bytes);
531 rpc_iwinfo_add_rateinfo(&a->rx_rate);
532 blobmsg_close_table(&buf, e);
533
534 e = blobmsg_open_table(&buf, "tx");
535 blobmsg_add_u32(&buf, "failed", a->tx_failed);
536 blobmsg_add_u32(&buf, "retries", a->tx_retries);
537 blobmsg_add_u32(&buf, "packets", a->tx_packets);
538 blobmsg_add_u32(&buf, "bytes", a->tx_bytes);
539 rpc_iwinfo_add_rateinfo(&a->tx_rate);
540 blobmsg_close_table(&buf, e);
541
542 found = true;
543 if (!macaddr)
544 blobmsg_close_table(&buf, d);
545 else
546 break;
547 }
548 }
549
550 if (!macaddr)
551 blobmsg_close_array(&buf, c);
552 else if (!found)
553 return UBUS_STATUS_NOT_FOUND;
554
555 ubus_send_reply(ctx, req, buf.head);
556
557 rpc_iwinfo_close();
558
559 return UBUS_STATUS_OK;
560 }
561
562 static int
563 rpc_iwinfo_survey(struct ubus_context *ctx, struct ubus_object *obj,
564 struct ubus_request_data *req, const char *method,
565 struct blob_attr *msg)
566 {
567 char res[IWINFO_BUFSIZE];
568 struct iwinfo_survey_entry *e;
569 void *c, *d;
570 int i, rv, len;
571
572 blob_buf_init(&buf, 0);
573
574 rv = rpc_iwinfo_open(msg);
575
576 c = blobmsg_open_array(&buf, "results");
577
578 if (rv || iw->survey(ifname, res, &len) || len < 0)
579 return UBUS_STATUS_OK;
580
581 for (i = 0; i < len; i += sizeof(struct iwinfo_survey_entry)) {
582 e = (struct iwinfo_survey_entry *)&res[i];
583
584 d = blobmsg_open_table(&buf, NULL);
585 blobmsg_add_u32(&buf, "mhz", e->mhz);
586 blobmsg_add_u32(&buf, "noise", e->noise);
587 blobmsg_add_u64(&buf, "active_time", e->active_time);
588 blobmsg_add_u64(&buf, "busy_time", e->busy_time);
589 blobmsg_add_u64(&buf, "busy_time_ext", e->busy_time_ext);
590 blobmsg_add_u64(&buf, "rx_time", e->rxtime);
591 blobmsg_add_u64(&buf, "tx_time", e->txtime);
592 blobmsg_close_table(&buf, d);
593 }
594
595 blobmsg_close_array(&buf, c);
596 ubus_send_reply(ctx, req, buf.head);
597 rpc_iwinfo_close();
598 return UBUS_STATUS_OK;
599 }
600
601 static int
602 rpc_iwinfo_freqlist(struct ubus_context *ctx, struct ubus_object *obj,
603 struct ubus_request_data *req, const char *method,
604 struct blob_attr *msg)
605 {
606 int i, rv, len, ch;
607 char res[IWINFO_BUFSIZE];
608 struct iwinfo_freqlist_entry *f;
609 void *c, *d;
610
611 rv = rpc_iwinfo_open(msg);
612
613 if (rv)
614 return rv;
615
616 blob_buf_init(&buf, 0);
617
618 c = blobmsg_open_array(&buf, "results");
619
620 if (!iw->freqlist(ifname, res, &len) && (len > 0))
621 {
622 if (iw->channel(ifname, &ch))
623 ch = -1;
624
625 for (i = 0; i < len; i += sizeof(struct iwinfo_freqlist_entry))
626 {
627 f = (struct iwinfo_freqlist_entry *)&res[i];
628 d = blobmsg_open_table(&buf, NULL);
629
630 blobmsg_add_u32(&buf, "channel", f->channel);
631 blobmsg_add_u32(&buf, "mhz", f->mhz);
632 blobmsg_add_u8(&buf, "restricted", f->restricted);
633
634 if (ch > -1)
635 blobmsg_add_u8(&buf, "active", f->channel == ch);
636
637 blobmsg_close_table(&buf, d);
638 }
639 }
640
641 blobmsg_close_array(&buf, c);
642
643 ubus_send_reply(ctx, req, buf.head);
644
645 rpc_iwinfo_close();
646
647 return UBUS_STATUS_OK;
648 }
649
650 static int
651 rpc_iwinfo_txpowerlist(struct ubus_context *ctx, struct ubus_object *obj,
652 struct ubus_request_data *req, const char *method,
653 struct blob_attr *msg)
654 {
655 int i, rv, len, pwr, off;
656 char res[IWINFO_BUFSIZE];
657 struct iwinfo_txpwrlist_entry *t;
658 void *c, *d;
659
660 rv = rpc_iwinfo_open(msg);
661
662 if (rv)
663 return rv;
664
665 blob_buf_init(&buf, 0);
666
667 c = blobmsg_open_array(&buf, "results");
668
669 if (!iw->txpwrlist(ifname, res, &len) && (len > 0))
670 {
671 if (iw->txpower(ifname, &pwr))
672 pwr = -1;
673
674 if (iw->txpower_offset(ifname, &off))
675 off = 0;
676
677 for (i = 0; i < len; i += sizeof(struct iwinfo_txpwrlist_entry))
678 {
679 t = (struct iwinfo_txpwrlist_entry *)&res[i];
680 d = blobmsg_open_table(&buf, NULL);
681
682 blobmsg_add_u32(&buf, "dbm", t->dbm + off);
683 blobmsg_add_u32(&buf, "mw", iwinfo_dbm2mw(t->dbm + off));
684
685 if (pwr > -1)
686 blobmsg_add_u8(&buf, "active", t->dbm == pwr);
687
688 blobmsg_close_table(&buf, d);
689 }
690 }
691
692 blobmsg_close_array(&buf, c);
693
694 ubus_send_reply(ctx, req, buf.head);
695
696 rpc_iwinfo_close();
697
698 return UBUS_STATUS_OK;
699 }
700
701 static const char *
702 rpc_iwinfo_lookup_country(char *buf, int len, int iso3166)
703 {
704 int i;
705 static char ccode[5];
706 struct iwinfo_country_entry *c;
707
708 for (i = 0; i < len; i += sizeof(struct iwinfo_country_entry))
709 {
710 c = (struct iwinfo_country_entry *)&buf[i];
711
712 if (c->iso3166 == iso3166)
713 {
714 snprintf(ccode, sizeof(ccode), "%s", c->ccode);
715 return ccode;
716 }
717 }
718
719 return NULL;
720 }
721
722 static int
723 rpc_iwinfo_countrylist(struct ubus_context *ctx, struct ubus_object *obj,
724 struct ubus_request_data *req, const char *method,
725 struct blob_attr *msg)
726 {
727 int rv, len;
728 char cur[3];
729 char iso3166[3];
730 char res[IWINFO_BUFSIZE] = {0};
731 const char *ccode;
732 const struct iwinfo_iso3166_label *l;
733 void *c, *d;
734
735 rv = rpc_iwinfo_open(msg);
736
737 if (rv)
738 return rv;
739
740 blob_buf_init(&buf, 0);
741
742 c = blobmsg_open_array(&buf, "results");
743
744 if (!iw->countrylist(ifname, res, &len) && (len > 0))
745 {
746 if (iw->country(ifname, cur))
747 memset(cur, 0, sizeof(cur));
748
749 for (l = IWINFO_ISO3166_NAMES; l->iso3166; l++)
750 {
751 ccode = rpc_iwinfo_lookup_country(res, len, l->iso3166);
752
753 if (!ccode)
754 continue;
755
756 d = blobmsg_open_table(&buf, NULL);
757
758 blobmsg_add_string(&buf, "code", ccode);
759 blobmsg_add_string(&buf, "country", (const char *)l->name);
760
761 snprintf(iso3166, sizeof(iso3166), "%c%c",
762 (l->iso3166 / 256), (l->iso3166 % 256));
763
764 blobmsg_add_string(&buf, "iso3166", iso3166);
765
766 if (cur[0])
767 blobmsg_add_u8(&buf, "active", !strncmp(ccode, cur, 2));
768
769 blobmsg_close_table(&buf, d);
770 }
771 }
772
773 blobmsg_close_array(&buf, c);
774
775 ubus_send_reply(ctx, req, buf.head);
776
777 rpc_iwinfo_close();
778
779 return UBUS_STATUS_OK;
780 }
781
782 static int
783 rpc_iwinfo_phyname(struct ubus_context *ctx, struct ubus_object *obj,
784 struct ubus_request_data *req, const char *method,
785 struct blob_attr *msg)
786 {
787 int i;
788 bool found = false;
789 char res[IWINFO_BUFSIZE];
790 const struct iwinfo_ops *ops;
791 struct blob_attr *tb[__RPC_U_MAX];
792 const char *backends[] = {
793 "nl80211",
794 "madwifi",
795 "wl"
796 };
797
798 blobmsg_parse(rpc_uci_policy, __RPC_U_MAX, tb,
799 blob_data(msg), blob_len(msg));
800
801 if (!tb[RPC_U_SECTION])
802 return UBUS_STATUS_INVALID_ARGUMENT;
803
804 for (i = 0; i < ARRAY_SIZE(backends); i++)
805 {
806 ops = iwinfo_backend_by_name(backends[i]);
807
808 if (!ops || !ops->lookup_phy)
809 continue;
810
811 if (!ops->lookup_phy(blobmsg_get_string(tb[RPC_U_SECTION]), res))
812 {
813 found = true;
814 break;
815 }
816 }
817
818 if (found)
819 {
820 blob_buf_init(&buf, 0);
821 blobmsg_add_string(&buf, "phyname", res);
822
823 ubus_send_reply(ctx, req, buf.head);
824 }
825
826 rpc_iwinfo_close();
827
828 return found ? UBUS_STATUS_OK : UBUS_STATUS_NOT_FOUND;
829 }
830
831 static int
832 rpc_iwinfo_devices(struct ubus_context *ctx, struct ubus_object *obj,
833 struct ubus_request_data *req, const char *method,
834 struct blob_attr *msg)
835 {
836 void *c;
837 struct dirent *e;
838 DIR *d;
839
840 d = opendir("/sys/class/net");
841
842 if (!d)
843 return UBUS_STATUS_UNKNOWN_ERROR;
844
845 blob_buf_init(&buf, 0);
846
847 c = blobmsg_open_array(&buf, "devices");
848
849 while ((e = readdir(d)) != NULL)
850 {
851 if (e->d_type != DT_LNK)
852 continue;
853
854 if (iwinfo_type(e->d_name))
855 blobmsg_add_string(&buf, NULL, e->d_name);
856 }
857
858 blobmsg_close_array(&buf, c);
859
860 closedir(d);
861
862 ubus_send_reply(ctx, req, buf.head);
863
864 rpc_iwinfo_close();
865
866 return UBUS_STATUS_OK;
867 }
868
869
870 static int
871 rpc_iwinfo_api_init(const struct rpc_daemon_ops *o, struct ubus_context *ctx)
872 {
873 static const struct ubus_method iwinfo_methods[] = {
874 UBUS_METHOD_NOARG("devices", rpc_iwinfo_devices),
875 UBUS_METHOD("info", rpc_iwinfo_info, rpc_device_policy),
876 UBUS_METHOD("scan", rpc_iwinfo_scan, rpc_device_policy),
877 UBUS_METHOD("assoclist", rpc_iwinfo_assoclist, rpc_assoclist_policy),
878 UBUS_METHOD("freqlist", rpc_iwinfo_freqlist, rpc_device_policy),
879 UBUS_METHOD("txpowerlist", rpc_iwinfo_txpowerlist, rpc_device_policy),
880 UBUS_METHOD("countrylist", rpc_iwinfo_countrylist, rpc_device_policy),
881 UBUS_METHOD("survey", rpc_iwinfo_survey, rpc_device_policy),
882 UBUS_METHOD("phyname", rpc_iwinfo_phyname, rpc_uci_policy),
883 };
884
885 static struct ubus_object_type iwinfo_type =
886 UBUS_OBJECT_TYPE("rpcd-plugin-iwinfo", iwinfo_methods);
887
888 static struct ubus_object obj = {
889 .name = "iwinfo",
890 .type = &iwinfo_type,
891 .methods = iwinfo_methods,
892 .n_methods = ARRAY_SIZE(iwinfo_methods),
893 };
894
895 return ubus_add_object(ctx, &obj);
896 }
897
898 struct rpc_plugin rpc_plugin = {
899 .init = rpc_iwinfo_api_init
900 };