return (int)res;
}
+static int iwinfo_bit(int value, int max)
+{
+ int i;
+
+ if (max > 31 || !(value & ((1 << max) - 1)))
+ return -1;
+
+ for (i = 0; i < max; i++)
+ {
+ if (value & 1)
+ break;
+
+ value >>= 1;
+ }
+
+ return i;
+}
+
+static const char * const iwinfo_name(int mask, int max, const char * const names[])
+{
+ int index = iwinfo_bit(mask, max);
+
+ if (index < 0)
+ return NULL;
+
+ return names[index];
+}
+
+const char * const iwinfo_band_name(int mask)
+{
+ return iwinfo_name(mask, IWINFO_BAND_COUNT, IWINFO_BAND_NAMES);
+}
+
+const char * const iwinfo_htmode_name(int mask)
+{
+ return iwinfo_name(mask, IWINFO_HTMODE_COUNT, IWINFO_HTMODE_NAMES);
+}
+
+uint32_t iwinfo_band2ghz(uint8_t band)
+{
+ switch (band)
+ {
+ case IWINFO_BAND_24:
+ return 2;
+ case IWINFO_BAND_5:
+ return 5;
+ case IWINFO_BAND_6:
+ return 6;
+ case IWINFO_BAND_60:
+ return 60;
+ }
+
+ return 0;
+}
+
+uint8_t iwinfo_ghz2band(uint32_t ghz)
+{
+ switch (ghz)
+ {
+ case 2:
+ return IWINFO_BAND_24;
+ case 5:
+ return IWINFO_BAND_5;
+ case 6:
+ return IWINFO_BAND_6;
+ case 60:
+ return IWINFO_BAND_60;
+ }
+
+ return 0;
+}
+
+size_t iwinfo_format_hwmodes(int modes, char *buf, size_t len)
+{
+ // bit numbers as per IWINFO_80211_*: ad ac ax a b g n
+ const int order[IWINFO_80211_COUNT] = { 5, 4, 6, 0, 1, 2, 3 };
+ size_t res = 0;
+ int i;
+
+ *buf = 0;
+
+ if (!(modes & ((1 << IWINFO_80211_COUNT) - 1)))
+ return 0;
+
+ for (i = 0; i < IWINFO_80211_COUNT; i++)
+ if (modes & 1 << order[i])
+ res += snprintf(buf + res, len - res, "%s/", IWINFO_80211_NAMES[order[i]]);
+
+ if (res > 0)
+ {
+ res--;
+ buf[res] = 0;
+ }
+
+ return res;
+}
+
+int iwinfo_htmode_is_ht(int htmode)
+{
+ switch (htmode)
+ {
+ case IWINFO_HTMODE_HT20:
+ case IWINFO_HTMODE_HT40:
+ return 1;
+ }
+
+ return 0;
+}
+
+int iwinfo_htmode_is_vht(int htmode)
+{
+ switch (htmode)
+ {
+ case IWINFO_HTMODE_VHT20:
+ case IWINFO_HTMODE_VHT40:
+ case IWINFO_HTMODE_VHT80:
+ case IWINFO_HTMODE_VHT80_80:
+ case IWINFO_HTMODE_VHT160:
+ return 1;
+ }
+
+ return 0;
+}
+
+int iwinfo_htmode_is_he(int htmode)
+{
+ switch (htmode)
+ {
+ case IWINFO_HTMODE_HE20:
+ case IWINFO_HTMODE_HE40:
+ case IWINFO_HTMODE_HE80:
+ case IWINFO_HTMODE_HE80_80:
+ case IWINFO_HTMODE_HE160:
+ return 1;
+ }
+
+ return 0;
+}
+
int iwinfo_ifup(const char *ifname)
{
struct ifreq ifr;
while (fgets(buf, sizeof(buf) - 1, db) != NULL)
{
+ if (buf[0] == '#')
+ continue;
+
memset(&e, 0, sizeof(e));
if (sscanf(buf, "%hx %hx %hx %hx %hd %hd \"%63[^\"]\" \"%63[^\"]\"",
&e.vendor_id, &e.device_id,
&e.subsystem_vendor_id, &e.subsystem_device_id,
&e.txpower_offset, &e.frequency_offset,
- e.vendor_name, e.device_name) < 8)
+ e.vendor_name, e.device_name) != 8 &&
+ sscanf(buf, "\"%127[^\"]\" %hd %hd \"%63[^\"]\" \"%63[^\"]\"",
+ e.compatible, &e.txpower_offset, &e.frequency_offset,
+ e.vendor_name, e.device_name) != 5)
continue;
if ((e.vendor_id != 0xffff) && (e.vendor_id != id->vendor_id))
(e.subsystem_device_id != id->subsystem_device_id))
continue;
+ if (strcmp(e.compatible, id->compatible))
+ continue;
+
rv = &e;
break;
}
}
/* Rt3xxx SoC */
- else if ((bc[off] == 0x3352) || (bc[off] == 0x5233) ||
+ else if ((bc[off] == 0x3050) || (bc[off] == 0x5030) ||
+ (bc[off] == 0x3051) || (bc[off] == 0x5130) ||
+ (bc[off] == 0x3052) || (bc[off] == 0x5230) ||
(bc[off] == 0x3350) || (bc[off] == 0x5033) ||
- (bc[off] == 0x3050) || (bc[off] == 0x5030) ||
- (bc[off] == 0x3052) || (bc[off] == 0x5230))
+ (bc[off] == 0x3352) || (bc[off] == 0x5233) ||
+ (bc[off] == 0x3662) || (bc[off] == 0x6236) ||
+ (bc[off] == 0x3883) || (bc[off] == 0x8338) ||
+ (bc[off] == 0x5350) || (bc[off] == 0x5053))
{
/* vendor: RaLink */
id->vendor_id = 0x1814;
id->subsystem_vendor_id = 0x1814;
/* device */
- if ((bc[off] & 0xf0) == 0x30)
+ if (((bc[off] & 0xf0) == 0x30) ||
+ ((bc[off] & 0xff) == 0x53))
+ id->device_id = (bc[off] >> 8) | (bc[off] & 0x00ff) << 8;
+ else
+ id->device_id = bc[off];
+
+ /* subsystem from EEPROM_NIC_CONF0_RF_TYPE */
+ id->subsystem_device_id = (bc[off + 0x1a] & 0x0f00) >> 8;
+ } else if ((bc[off] == 0x7620) || (bc[off] == 0x2076) ||
+ (bc[off] == 0x7628) || (bc[off] == 0x2876) ||
+ (bc[off] == 0x7688) || (bc[off] == 0x8876)) {
+ /* vendor: MediaTek */
+ id->vendor_id = 0x14c3;
+ id->subsystem_vendor_id = 0x14c3;
+
+ /* device */
+ if ((bc[off] & 0xff) == 0x76)
id->device_id = (bc[off] >> 8) | (bc[off] & 0x00ff) << 8;
else
id->device_id = bc[off];
return (id->vendor_id && id->device_id) ? 0 : -1;
}
+static void iwinfo_parse_rsn_cipher(uint8_t idx, uint16_t *ciphers)
+{
+ switch (idx)
+ {
+ case 0:
+ *ciphers |= IWINFO_CIPHER_NONE;
+ break;
+
+ case 1:
+ *ciphers |= IWINFO_CIPHER_WEP40;
+ break;
+
+ case 2:
+ *ciphers |= IWINFO_CIPHER_TKIP;
+ break;
+
+ case 3: /* WRAP */
+ break;
+
+ case 4:
+ *ciphers |= IWINFO_CIPHER_CCMP;
+ break;
+
+ case 5:
+ *ciphers |= IWINFO_CIPHER_WEP104;
+ break;
+
+ case 8:
+ *ciphers |= IWINFO_CIPHER_GCMP;
+ break;
+
+ case 9:
+ *ciphers |= IWINFO_CIPHER_GCMP256;
+ break;
+
+ case 10:
+ *ciphers |= IWINFO_CIPHER_CCMP256;
+ break;
+
+ case 6: /* AES-128-CMAC */
+ case 7: /* No group addressed */
+ case 11: /* BIP-GMAC-128 */
+ case 12: /* BIP-GMAC-256 */
+ case 13: /* BIP-CMAC-256 */
+ break;
+ }
+}
+
void iwinfo_parse_rsn(struct iwinfo_crypto_entry *c, uint8_t *data, uint8_t len,
- uint8_t defcipher, uint8_t defauth)
+ uint16_t defcipher, uint8_t defauth)
{
uint16_t i, count;
+ uint8_t wpa_version = 0;
static unsigned char ms_oui[3] = { 0x00, 0x50, 0xf2 };
static unsigned char ieee80211_oui[3] = { 0x00, 0x0f, 0xac };
len -= 2;
if (!memcmp(data, ms_oui, 3))
- c->wpa_version += 1;
+ wpa_version |= 1;
else if (!memcmp(data, ieee80211_oui, 3))
- c->wpa_version += 2;
+ wpa_version |= 2;
if (len < 4)
{
}
if (!memcmp(data, ms_oui, 3) || !memcmp(data, ieee80211_oui, 3))
- {
- switch (data[3])
- {
- case 1: c->group_ciphers |= IWINFO_CIPHER_WEP40; break;
- case 2: c->group_ciphers |= IWINFO_CIPHER_TKIP; break;
- case 4: c->group_ciphers |= IWINFO_CIPHER_CCMP; break;
- case 5: c->group_ciphers |= IWINFO_CIPHER_WEP104; break;
- case 6: /* AES-128-CMAC */ break;
- default: /* proprietary */ break;
- }
- }
+ iwinfo_parse_rsn_cipher(data[3], &c->group_ciphers);
data += 4;
len -= 4;
return;
for (i = 0; i < count; i++)
- {
if (!memcmp(data + 2 + (i * 4), ms_oui, 3) ||
- !memcmp(data + 2 + (i * 4), ieee80211_oui, 3))
- {
- switch (data[2 + (i * 4) + 3])
- {
- case 1: c->pair_ciphers |= IWINFO_CIPHER_WEP40; break;
- case 2: c->pair_ciphers |= IWINFO_CIPHER_TKIP; break;
- case 4: c->pair_ciphers |= IWINFO_CIPHER_CCMP; break;
- case 5: c->pair_ciphers |= IWINFO_CIPHER_WEP104; break;
- case 6: /* AES-128-CMAC */ break;
- default: /* proprietary */ break;
- }
- }
- }
+ !memcmp(data + 2 + (i * 4), ieee80211_oui, 3))
+ iwinfo_parse_rsn_cipher(data[2 + (i * 4) + 3], &c->pair_ciphers);
data += 2 + (count * 4);
len -= 2 + (count * 4);
{
switch (data[2 + (i * 4) + 3])
{
- case 1: c->auth_suites |= IWINFO_KMGMT_8021x; break;
- case 2: c->auth_suites |= IWINFO_KMGMT_PSK; break;
- case 3: /* FT/IEEE 802.1X */ break;
- case 4: /* FT/PSK */ break;
- case 5: /* IEEE 802.1X/SHA-256 */ break;
- case 6: /* PSK/SHA-256 */ break;
- default: /* proprietary */ break;
+ case 1: /* IEEE 802.1x */
+ c->wpa_version |= wpa_version;
+ c->auth_suites |= IWINFO_KMGMT_8021x;
+ break;
+
+ case 2: /* PSK */
+ c->wpa_version |= wpa_version;
+ c->auth_suites |= IWINFO_KMGMT_PSK;
+ break;
+
+ case 3: /* FT/IEEE 802.1X */
+ case 4: /* FT/PSK */
+ case 5: /* IEEE 802.1X/SHA-256 */
+ case 6: /* PSK/SHA-256 */
+ case 7: /* TPK Handshake */
+ break;
+
+ case 8: /* SAE */
+ c->wpa_version |= 4;
+ c->auth_suites |= IWINFO_KMGMT_SAE;
+ break;
+
+ case 9: /* FT/SAE */
+ case 10: /* undefined */
+ break;
+
+ case 11: /* 802.1x Suite-B */
+ case 12: /* 802.1x Suite-B-192 */
+ case 13: /* FT/802.1x SHA-384 */
+ c->wpa_version |= 4;
+ c->auth_suites |= IWINFO_KMGMT_8021x;
+ break;
+
+ case 14: /* FILS SHA-256 */
+ case 15: /* FILS SHA-384 */
+ case 16: /* FT/FILS SHA-256 */
+ case 17: /* FT/FILS SHA-384 */
+ break;
+
+ case 18: /* OWE */
+ c->wpa_version |= 4;
+ c->auth_suites |= IWINFO_KMGMT_OWE;
+ break;
}
}
}
uci_free_context(uci_ctx);
uci_ctx = NULL;
}
+
+
+struct iwinfo_ubus_query_state {
+ const char *ifname;
+ const char *field;
+ size_t len;
+ char *buf;
+};
+
+static void iwinfo_ubus_query_cb(struct ubus_request *req, int type,
+ struct blob_attr *msg)
+{
+ struct iwinfo_ubus_query_state *st = req->priv;
+
+ struct blobmsg_policy pol1[2] = {
+ { "ifname", BLOBMSG_TYPE_STRING },
+ { "config", BLOBMSG_TYPE_TABLE }
+ };
+
+ struct blobmsg_policy pol2 = { st->field, BLOBMSG_TYPE_STRING };
+ struct blob_attr *cur, *cur2, *cur3, *cfg[2], *res;
+ int rem, rem2, rem3;
+
+ blobmsg_for_each_attr(cur, msg, rem) {
+ if (blobmsg_type(cur) != BLOBMSG_TYPE_TABLE)
+ continue;
+
+ blobmsg_for_each_attr(cur2, cur, rem2) {
+ if (blobmsg_type(cur2) != BLOBMSG_TYPE_ARRAY)
+ continue;
+
+ if (strcmp(blobmsg_name(cur2), "interfaces"))
+ continue;
+
+ blobmsg_for_each_attr(cur3, cur2, rem3) {
+ blobmsg_parse(pol1, sizeof(pol1) / sizeof(pol1[0]), cfg,
+ blobmsg_data(cur3), blobmsg_len(cur3));
+
+ if (!cfg[0] || !cfg[1] ||
+ strcmp(blobmsg_get_string(cfg[0]), st->ifname))
+ continue;
+
+ blobmsg_parse(&pol2, 1, &res,
+ blobmsg_data(cfg[1]), blobmsg_len(cfg[1]));
+
+ if (!res)
+ continue;
+
+ strncpy(st->buf, blobmsg_get_string(res), st->len);
+ return;
+ }
+ }
+ }
+}
+
+int iwinfo_ubus_query(const char *ifname, const char *field,
+ char *buf, size_t len)
+{
+ struct iwinfo_ubus_query_state st = {
+ .ifname = ifname,
+ .field = field,
+ .buf = buf,
+ .len = len
+ };
+
+ struct ubus_context *ctx = NULL;
+ struct blob_buf b = { };
+ int rv = -1;
+ uint32_t id;
+
+ blob_buf_init(&b, 0);
+
+ ctx = ubus_connect(NULL);
+
+ if (!ctx)
+ goto out;
+
+ if (ubus_lookup_id(ctx, "network.wireless", &id))
+ goto out;
+
+ if (ubus_invoke(ctx, id, "status", b.head, iwinfo_ubus_query_cb, &st, 250))
+ goto out;
+
+ rv = 0;
+
+out:
+ if (ctx)
+ ubus_free(ctx);
+
+ blob_buf_free(&b);
+
+ return rv;
+}