123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448 |
- /*
- * Copyright 2003-2005 Devicescape Software, Inc.
- * Copyright (c) 2006 Jiri Benc <jbenc@suse.cz>
- * Copyright 2007 Johannes Berg <johannes@sipsolutions.net>
- * Copyright (C) 2015 Intel Deutschland GmbH
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- */
- #include <linux/kobject.h>
- #include <linux/slab.h>
- #include "ieee80211_i.h"
- #include "key.h"
- #include "debugfs.h"
- #include "debugfs_key.h"
- #define KEY_READ(name, prop, format_string) \
- static ssize_t key_##name##_read(struct file *file, \
- char __user *userbuf, \
- size_t count, loff_t *ppos) \
- { \
- struct ieee80211_key *key = file->private_data; \
- return mac80211_format_buffer(userbuf, count, ppos, \
- format_string, key->prop); \
- }
- #define KEY_READ_D(name) KEY_READ(name, name, "%d\n")
- #define KEY_READ_X(name) KEY_READ(name, name, "0x%x\n")
- #define KEY_OPS(name) \
- static const struct file_operations key_ ##name## _ops = { \
- .read = key_##name##_read, \
- .open = simple_open, \
- .llseek = generic_file_llseek, \
- }
- #define KEY_OPS_W(name) \
- static const struct file_operations key_ ##name## _ops = { \
- .read = key_##name##_read, \
- .write = key_##name##_write, \
- .open = simple_open, \
- .llseek = generic_file_llseek, \
- }
- #define KEY_FILE(name, format) \
- KEY_READ_##format(name) \
- KEY_OPS(name)
- #define KEY_CONF_READ(name, format_string) \
- KEY_READ(conf_##name, conf.name, format_string)
- #define KEY_CONF_READ_D(name) KEY_CONF_READ(name, "%d\n")
- #define KEY_CONF_OPS(name) \
- static const struct file_operations key_ ##name## _ops = { \
- .read = key_conf_##name##_read, \
- .open = simple_open, \
- .llseek = generic_file_llseek, \
- }
- #define KEY_CONF_FILE(name, format) \
- KEY_CONF_READ_##format(name) \
- KEY_CONF_OPS(name)
- KEY_CONF_FILE(keylen, D);
- KEY_CONF_FILE(keyidx, D);
- KEY_CONF_FILE(hw_key_idx, D);
- KEY_FILE(flags, X);
- KEY_READ(ifindex, sdata->name, "%s\n");
- KEY_OPS(ifindex);
- static ssize_t key_algorithm_read(struct file *file,
- char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- char buf[15];
- struct ieee80211_key *key = file->private_data;
- u32 c = key->conf.cipher;
- sprintf(buf, "%.2x-%.2x-%.2x:%d\n",
- c >> 24, (c >> 16) & 0xff, (c >> 8) & 0xff, c & 0xff);
- return simple_read_from_buffer(userbuf, count, ppos, buf, strlen(buf));
- }
- KEY_OPS(algorithm);
- static ssize_t key_tx_spec_write(struct file *file, const char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- struct ieee80211_key *key = file->private_data;
- u64 pn;
- int ret;
- switch (key->conf.cipher) {
- case WLAN_CIPHER_SUITE_WEP40:
- case WLAN_CIPHER_SUITE_WEP104:
- return -EINVAL;
- case WLAN_CIPHER_SUITE_TKIP:
- /* not supported yet */
- return -EOPNOTSUPP;
- case WLAN_CIPHER_SUITE_CCMP:
- case WLAN_CIPHER_SUITE_CCMP_256:
- case WLAN_CIPHER_SUITE_AES_CMAC:
- case WLAN_CIPHER_SUITE_BIP_CMAC_256:
- case WLAN_CIPHER_SUITE_BIP_GMAC_128:
- case WLAN_CIPHER_SUITE_BIP_GMAC_256:
- case WLAN_CIPHER_SUITE_GCMP:
- case WLAN_CIPHER_SUITE_GCMP_256:
- ret = kstrtou64_from_user(userbuf, count, 16, &pn);
- if (ret)
- return ret;
- /* PN is a 48-bit counter */
- if (pn >= (1ULL << 48))
- return -ERANGE;
- atomic64_set(&key->conf.tx_pn, pn);
- return count;
- default:
- return 0;
- }
- }
- static ssize_t key_tx_spec_read(struct file *file, char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- u64 pn;
- char buf[20];
- int len;
- struct ieee80211_key *key = file->private_data;
- switch (key->conf.cipher) {
- case WLAN_CIPHER_SUITE_WEP40:
- case WLAN_CIPHER_SUITE_WEP104:
- len = scnprintf(buf, sizeof(buf), "\n");
- break;
- case WLAN_CIPHER_SUITE_TKIP:
- pn = atomic64_read(&key->conf.tx_pn);
- len = scnprintf(buf, sizeof(buf), "%08x %04x\n",
- TKIP_PN_TO_IV32(pn),
- TKIP_PN_TO_IV16(pn));
- break;
- case WLAN_CIPHER_SUITE_CCMP:
- case WLAN_CIPHER_SUITE_CCMP_256:
- case WLAN_CIPHER_SUITE_AES_CMAC:
- case WLAN_CIPHER_SUITE_BIP_CMAC_256:
- case WLAN_CIPHER_SUITE_BIP_GMAC_128:
- case WLAN_CIPHER_SUITE_BIP_GMAC_256:
- case WLAN_CIPHER_SUITE_GCMP:
- case WLAN_CIPHER_SUITE_GCMP_256:
- pn = atomic64_read(&key->conf.tx_pn);
- len = scnprintf(buf, sizeof(buf), "%02x%02x%02x%02x%02x%02x\n",
- (u8)(pn >> 40), (u8)(pn >> 32), (u8)(pn >> 24),
- (u8)(pn >> 16), (u8)(pn >> 8), (u8)pn);
- break;
- default:
- return 0;
- }
- return simple_read_from_buffer(userbuf, count, ppos, buf, len);
- }
- KEY_OPS_W(tx_spec);
- static ssize_t key_rx_spec_read(struct file *file, char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- struct ieee80211_key *key = file->private_data;
- char buf[14*IEEE80211_NUM_TIDS+1], *p = buf;
- int i, len;
- const u8 *rpn;
- switch (key->conf.cipher) {
- case WLAN_CIPHER_SUITE_WEP40:
- case WLAN_CIPHER_SUITE_WEP104:
- len = scnprintf(buf, sizeof(buf), "\n");
- break;
- case WLAN_CIPHER_SUITE_TKIP:
- for (i = 0; i < IEEE80211_NUM_TIDS; i++)
- p += scnprintf(p, sizeof(buf)+buf-p,
- "%08x %04x\n",
- key->u.tkip.rx[i].iv32,
- key->u.tkip.rx[i].iv16);
- len = p - buf;
- break;
- case WLAN_CIPHER_SUITE_CCMP:
- case WLAN_CIPHER_SUITE_CCMP_256:
- for (i = 0; i < IEEE80211_NUM_TIDS + 1; i++) {
- rpn = key->u.ccmp.rx_pn[i];
- p += scnprintf(p, sizeof(buf)+buf-p,
- "%02x%02x%02x%02x%02x%02x\n",
- rpn[0], rpn[1], rpn[2],
- rpn[3], rpn[4], rpn[5]);
- }
- len = p - buf;
- break;
- case WLAN_CIPHER_SUITE_AES_CMAC:
- case WLAN_CIPHER_SUITE_BIP_CMAC_256:
- rpn = key->u.aes_cmac.rx_pn;
- p += scnprintf(p, sizeof(buf)+buf-p,
- "%02x%02x%02x%02x%02x%02x\n",
- rpn[0], rpn[1], rpn[2],
- rpn[3], rpn[4], rpn[5]);
- len = p - buf;
- break;
- case WLAN_CIPHER_SUITE_BIP_GMAC_128:
- case WLAN_CIPHER_SUITE_BIP_GMAC_256:
- rpn = key->u.aes_gmac.rx_pn;
- p += scnprintf(p, sizeof(buf)+buf-p,
- "%02x%02x%02x%02x%02x%02x\n",
- rpn[0], rpn[1], rpn[2],
- rpn[3], rpn[4], rpn[5]);
- len = p - buf;
- break;
- case WLAN_CIPHER_SUITE_GCMP:
- case WLAN_CIPHER_SUITE_GCMP_256:
- for (i = 0; i < IEEE80211_NUM_TIDS + 1; i++) {
- rpn = key->u.gcmp.rx_pn[i];
- p += scnprintf(p, sizeof(buf)+buf-p,
- "%02x%02x%02x%02x%02x%02x\n",
- rpn[0], rpn[1], rpn[2],
- rpn[3], rpn[4], rpn[5]);
- }
- len = p - buf;
- break;
- default:
- return 0;
- }
- return simple_read_from_buffer(userbuf, count, ppos, buf, len);
- }
- KEY_OPS(rx_spec);
- static ssize_t key_replays_read(struct file *file, char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- struct ieee80211_key *key = file->private_data;
- char buf[20];
- int len;
- switch (key->conf.cipher) {
- case WLAN_CIPHER_SUITE_CCMP:
- case WLAN_CIPHER_SUITE_CCMP_256:
- len = scnprintf(buf, sizeof(buf), "%u\n", key->u.ccmp.replays);
- break;
- case WLAN_CIPHER_SUITE_AES_CMAC:
- case WLAN_CIPHER_SUITE_BIP_CMAC_256:
- len = scnprintf(buf, sizeof(buf), "%u\n",
- key->u.aes_cmac.replays);
- break;
- case WLAN_CIPHER_SUITE_BIP_GMAC_128:
- case WLAN_CIPHER_SUITE_BIP_GMAC_256:
- len = scnprintf(buf, sizeof(buf), "%u\n",
- key->u.aes_gmac.replays);
- break;
- case WLAN_CIPHER_SUITE_GCMP:
- case WLAN_CIPHER_SUITE_GCMP_256:
- len = scnprintf(buf, sizeof(buf), "%u\n", key->u.gcmp.replays);
- break;
- default:
- return 0;
- }
- return simple_read_from_buffer(userbuf, count, ppos, buf, len);
- }
- KEY_OPS(replays);
- static ssize_t key_icverrors_read(struct file *file, char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- struct ieee80211_key *key = file->private_data;
- char buf[20];
- int len;
- switch (key->conf.cipher) {
- case WLAN_CIPHER_SUITE_AES_CMAC:
- case WLAN_CIPHER_SUITE_BIP_CMAC_256:
- len = scnprintf(buf, sizeof(buf), "%u\n",
- key->u.aes_cmac.icverrors);
- break;
- case WLAN_CIPHER_SUITE_BIP_GMAC_128:
- case WLAN_CIPHER_SUITE_BIP_GMAC_256:
- len = scnprintf(buf, sizeof(buf), "%u\n",
- key->u.aes_gmac.icverrors);
- break;
- default:
- return 0;
- }
- return simple_read_from_buffer(userbuf, count, ppos, buf, len);
- }
- KEY_OPS(icverrors);
- static ssize_t key_mic_failures_read(struct file *file, char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- struct ieee80211_key *key = file->private_data;
- char buf[20];
- int len;
- if (key->conf.cipher != WLAN_CIPHER_SUITE_TKIP)
- return -EINVAL;
- len = scnprintf(buf, sizeof(buf), "%u\n", key->u.tkip.mic_failures);
- return simple_read_from_buffer(userbuf, count, ppos, buf, len);
- }
- KEY_OPS(mic_failures);
- static ssize_t key_key_read(struct file *file, char __user *userbuf,
- size_t count, loff_t *ppos)
- {
- struct ieee80211_key *key = file->private_data;
- int i, bufsize = 2 * key->conf.keylen + 2;
- char *buf = kmalloc(bufsize, GFP_KERNEL);
- char *p = buf;
- ssize_t res;
- if (!buf)
- return -ENOMEM;
- for (i = 0; i < key->conf.keylen; i++)
- p += scnprintf(p, bufsize + buf - p, "%02x", key->conf.key[i]);
- p += scnprintf(p, bufsize+buf-p, "\n");
- res = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
- kfree(buf);
- return res;
- }
- KEY_OPS(key);
- #define DEBUGFS_ADD(name) \
- debugfs_create_file(#name, 0400, key->debugfs.dir, \
- key, &key_##name##_ops);
- #define DEBUGFS_ADD_W(name) \
- debugfs_create_file(#name, 0600, key->debugfs.dir, \
- key, &key_##name##_ops);
- void ieee80211_debugfs_key_add(struct ieee80211_key *key)
- {
- static int keycount;
- char buf[100];
- struct sta_info *sta;
- if (!key->local->debugfs.keys)
- return;
- sprintf(buf, "%d", keycount);
- key->debugfs.cnt = keycount;
- keycount++;
- key->debugfs.dir = debugfs_create_dir(buf,
- key->local->debugfs.keys);
- if (!key->debugfs.dir)
- return;
- sta = key->sta;
- if (sta) {
- sprintf(buf, "../../netdev:%s/stations/%pM",
- sta->sdata->name, sta->sta.addr);
- key->debugfs.stalink =
- debugfs_create_symlink("station", key->debugfs.dir, buf);
- }
- DEBUGFS_ADD(keylen);
- DEBUGFS_ADD(flags);
- DEBUGFS_ADD(keyidx);
- DEBUGFS_ADD(hw_key_idx);
- DEBUGFS_ADD(algorithm);
- DEBUGFS_ADD_W(tx_spec);
- DEBUGFS_ADD(rx_spec);
- DEBUGFS_ADD(replays);
- DEBUGFS_ADD(icverrors);
- DEBUGFS_ADD(mic_failures);
- DEBUGFS_ADD(key);
- DEBUGFS_ADD(ifindex);
- };
- void ieee80211_debugfs_key_remove(struct ieee80211_key *key)
- {
- if (!key)
- return;
- debugfs_remove_recursive(key->debugfs.dir);
- key->debugfs.dir = NULL;
- }
- void ieee80211_debugfs_key_update_default(struct ieee80211_sub_if_data *sdata)
- {
- char buf[50];
- struct ieee80211_key *key;
- if (!sdata->vif.debugfs_dir)
- return;
- lockdep_assert_held(&sdata->local->key_mtx);
- debugfs_remove(sdata->debugfs.default_unicast_key);
- sdata->debugfs.default_unicast_key = NULL;
- if (sdata->default_unicast_key) {
- key = key_mtx_dereference(sdata->local,
- sdata->default_unicast_key);
- sprintf(buf, "../keys/%d", key->debugfs.cnt);
- sdata->debugfs.default_unicast_key =
- debugfs_create_symlink("default_unicast_key",
- sdata->vif.debugfs_dir, buf);
- }
- debugfs_remove(sdata->debugfs.default_multicast_key);
- sdata->debugfs.default_multicast_key = NULL;
- if (sdata->default_multicast_key) {
- key = key_mtx_dereference(sdata->local,
- sdata->default_multicast_key);
- sprintf(buf, "../keys/%d", key->debugfs.cnt);
- sdata->debugfs.default_multicast_key =
- debugfs_create_symlink("default_multicast_key",
- sdata->vif.debugfs_dir, buf);
- }
- }
- void ieee80211_debugfs_key_add_mgmt_default(struct ieee80211_sub_if_data *sdata)
- {
- char buf[50];
- struct ieee80211_key *key;
- if (!sdata->vif.debugfs_dir)
- return;
- key = key_mtx_dereference(sdata->local,
- sdata->default_mgmt_key);
- if (key) {
- sprintf(buf, "../keys/%d", key->debugfs.cnt);
- sdata->debugfs.default_mgmt_key =
- debugfs_create_symlink("default_mgmt_key",
- sdata->vif.debugfs_dir, buf);
- } else
- ieee80211_debugfs_key_remove_mgmt_default(sdata);
- }
- void ieee80211_debugfs_key_remove_mgmt_default(struct ieee80211_sub_if_data *sdata)
- {
- if (!sdata)
- return;
- debugfs_remove(sdata->debugfs.default_mgmt_key);
- sdata->debugfs.default_mgmt_key = NULL;
- }
- void ieee80211_debugfs_key_sta_del(struct ieee80211_key *key,
- struct sta_info *sta)
- {
- debugfs_remove(key->debugfs.stalink);
- key->debugfs.stalink = NULL;
- }
|