drivers/net/wireless/iwlwifi/iwl-debugfs.c

   1 /******************************************************************************
   2  *
   3  * GPL LICENSE SUMMARY
   4  *
   5  * Copyright(c) 2008 Intel Corporation. All rights reserved.
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of version 2 of the GNU General Public License as
   9  * published by the Free Software Foundation.
  10  *
  11  * This program is distributed in the hope that it will be useful, but
  12  * WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
  19  * USA
  20  *
  21  * The full GNU General Public License is included in this distribution
  22  * in the file called LICENSE.GPL.
  23  *
  24  * Contact Information:
  25  * Tomas Winkler <tomas.winkler@intel.com>
  26  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  27  *****************************************************************************/
  28
  29 #include <linux/kernel.h>
  30 #include <linux/module.h>
  31 #include <linux/debugfs.h>
  32
  33 #include <linux/ieee80211.h>
  34 #include <net/mac80211.h>
  35
  36
  37 #include "iwl-4965.h"
  38 #include "iwl-debug.h"
  39 #include "iwl-io.h"
  40
  41
  42 /* create and remove of files */
  43 #define DEBUGFS_ADD_DIR(name, parent) do {                              \
  44         dbgfs->dir_##name = debugfs_create_dir(#name, parent);          \
  45         if (!(dbgfs->dir_##name))                                       \
  46                 goto err;                                               \
  47 } while (0)
  48
  49 #define DEBUGFS_ADD_FILE(name, parent) do {                             \
  50         dbgfs->dbgfs_##parent##_files.file_##name =                     \
  51         debugfs_create_file(#name, 0644, dbgfs->dir_##parent, priv,     \
  52                                 &iwl_dbgfs_##name##_ops);               \
  53         if (!(dbgfs->dbgfs_##parent##_files.file_##name))               \
  54                 goto err;                                               \
  55 } while (0)
  56
  57 #define DEBUGFS_REMOVE(name)  do {              \
  58         debugfs_remove(name);                   \
  59         name = NULL;                            \
  60 } while (0);
  61
  62 /* file operation */
  63 #define DEBUGFS_READ_FUNC(name)                                         \
  64 static ssize_t iwl_dbgfs_##name##_read(struct file *file,               \
  65                                         char __user *user_buf,          \
  66                                         size_t count, loff_t *ppos);
  67
  68 #define DEBUGFS_WRITE_FUNC(name)                                        \
  69 static ssize_t iwl_dbgfs_##name##_write(struct file *file,              \
  70                                         const char __user *user_buf,    \
  71                                         size_t count, loff_t *ppos);
  72
  73
  74 static int iwl_dbgfs_open_file_generic(struct inode *inode, struct file *file)
  75 {
  76         file->private_data = inode->i_private;
  77         return 0;
  78 }
  79
  80 #define DEBUGFS_READ_FILE_OPS(name)                                     \
  81         DEBUGFS_READ_FUNC(name);                                        \
  82 static const struct file_operations iwl_dbgfs_##name##_ops = {          \
  83         .read = iwl_dbgfs_##name##_read,                                \
  84         .open = iwl_dbgfs_open_file_generic,                            \
  85 };
  86
  87 #define DEBUGFS_READ_WRITE_FILE_OPS(name)                               \
  88         DEBUGFS_READ_FUNC(name);                                        \
  89         DEBUGFS_WRITE_FUNC(name);                                       \
  90 static const struct file_operations iwl_dbgfs_##name##_ops = {          \
  91         .write = iwl_dbgfs_##name##_write,                              \
  92         .read = iwl_dbgfs_##name##_read,                                \
  93         .open = iwl_dbgfs_open_file_generic,                            \
  94 };
  95
  96
  97 static ssize_t iwl_dbgfs_tx_statistics_read(struct file *file,
  98                                                 char __user *user_buf,
  99                                                 size_t count, loff_t *ppos) {
 100
 101         struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
 102         char buf[256];
 103         int pos = 0;
 104
 105         pos += sprintf(buf+pos, "mgmt: %u\n", priv->tx_stats[0].cnt);
 106         pos += sprintf(buf+pos, "ctrl: %u\n", priv->tx_stats[1].cnt);
 107         pos += sprintf(buf+pos, "data: %u\n", priv->tx_stats[2].cnt);
 108
 109         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
 110 }
 111
 112 static ssize_t iwl_dbgfs_rx_statistics_read(struct file *file,
 113                                                 char __user *user_buf,
 114                                                 size_t count, loff_t *ppos) {
 115
 116         struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
 117         char buf[256];
 118         int pos = 0;
 119
 120         pos += sprintf(buf+pos, "mgmt: %u\n", priv->rx_stats[0].cnt);
 121         pos += sprintf(buf+pos, "ctrl: %u\n", priv->rx_stats[1].cnt);
 122         pos += sprintf(buf+pos, "data: %u\n", priv->rx_stats[2].cnt);
 123
 124         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
 125 }
 126
 127 #define BYTE1_MASK 0x000000ff;
 128 #define BYTE2_MASK 0x0000ffff;
 129 #define BYTE3_MASK 0x00ffffff;
 130 static ssize_t iwl_dbgfs_sram_read(struct file *file,
 131                                         char __user *user_buf,
 132                                         size_t count, loff_t *ppos)
 133 {
 134         u32 val;
 135         char buf[1024];
 136         ssize_t ret;
 137         int i;
 138         int pos = 0;
 139         struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
 140
 141         printk(KERN_DEBUG "offset is: 0x%x\tlen is: 0x%x\n",
 142         priv->dbgfs->sram_offset, priv->dbgfs->sram_len);
 143
 144         iwl_grab_nic_access(priv);
 145         for (i = priv->dbgfs->sram_len; i > 0; i -= 4) {
 146                 val = iwl_read_targ_mem(priv, priv->dbgfs->sram_offset + \
 147                                         priv->dbgfs->sram_len - i);
 148                 if (i < 4) {
 149                         switch (i) {
 150                         case 1:
 151                                 val &= BYTE1_MASK;
 152                                 break;
 153                         case 2:
 154                                 val &= BYTE2_MASK;
 155                                 break;
 156                         case 3:
 157                                 val &= BYTE3_MASK;
 158                                 break;
 159                         }
 160                 }
 161                 pos += sprintf(buf+pos, "0x%08x ", val);
 162         }
 163         pos += sprintf(buf+pos, "\n");
 164         iwl_release_nic_access(priv);
 165
 166         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
 167         return ret;
 168 }
 169
 170 static ssize_t iwl_dbgfs_sram_write(struct file *file,
 171                                         const char __user *user_buf,
 172                                         size_t count, loff_t *ppos)
 173 {
 174         struct iwl_priv *priv = file->private_data;
 175         char buf[64];
 176         int buf_size;
 177         u32 offset, len;
 178
 179         memset(buf, 0, sizeof(buf));
 180         buf_size = min(count, sizeof(buf) -  1);
 181         if (copy_from_user(buf, user_buf, buf_size))
 182                 return -EFAULT;
 183
 184         if (sscanf(buf, "%x,%x", &offset, &len) == 2) {
 185                 priv->dbgfs->sram_offset = offset;
 186                 priv->dbgfs->sram_len = len;
 187         } else {
 188                 priv->dbgfs->sram_offset = 0;
 189                 priv->dbgfs->sram_len = 0;
 190         }
 191
 192         return count;
 193 }
 194
 195 static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf,
 196                                         size_t count, loff_t *ppos)
 197 {
 198         struct iwl_priv *priv = (struct iwl_priv *)file->private_data;
 199         struct iwl4965_station_entry *station;
 200         int max_sta = priv->hw_setting.max_stations;
 201         char *buf;
 202         int i, j, pos = 0;
 203         ssize_t ret;
 204         /* Add 30 for initial string */
 205         const size_t bufsz = 30 + sizeof(char) * 500 * (priv->num_stations);
 206         DECLARE_MAC_BUF(mac);
 207
 208         buf = kmalloc(bufsz, GFP_KERNEL);
 209         if(!buf)
 210                 return -ENOMEM;
 211
 212         pos += sprintf(buf+pos, "num of stations: %d\n\n",
 213                         priv->num_stations);
 214
 215         for (i = 0; i < max_sta; i++) {
 216                 station = &priv->stations[i];
 217                 if (station->used) {
 218                         pos += sprintf(buf+pos, "station %d:\ngeneral data:\n",
 219                                         i+1);
 220                         print_mac(mac, station->sta.sta.addr);
 221                         pos += sprintf(buf+pos, "id: %u\n",
 222                                         station->sta.sta.sta_id);
 223                         pos += sprintf(buf+pos, "mode: %u\n",
 224                                         station->sta.mode);
 225                         pos += sprintf(buf+pos, "flags: 0x%x\n",
 226                                         station->sta.station_flags_msk);
 227                         pos += sprintf(buf+pos, "ps_status: %u\n",
 228                                         station->ps_status);
 229
 230                         pos += sprintf(buf+pos, "tid data:\n");
 231
 232                         pos += sprintf(buf+pos, "seq_num\t\ttxq_id\t");
 233                         pos += sprintf(buf+pos, "frame_count\twait_for_ba\t");
 234                         pos += sprintf(buf+pos, "start_idx\tbitmap0\t");
 235                         pos += sprintf(buf+pos, "bitmap1\trate_n_flags\n");
 236
 237                         for (j = 0; j < MAX_TID_COUNT; j++) {
 238                                 pos += sprintf(buf+pos, "[%d]:\t\t%u\t",
 239                                                 j, station->tid[j].seq_number);
 240                                 pos += sprintf(buf+pos, "%u\t\t%u\t\t%u\t\t",
 241                                                 station->tid[j].agg.txq_id,
 242                                                 station->tid[j].agg.frame_count,
 243                                                 station->tid[j].agg.wait_for_ba);
 244                                 pos += sprintf(buf+pos, "%u\t%llu\t%u\n",
 245                                                 station->tid[j].agg.start_idx,
 246                                                 station->tid[j].agg.bitmap,
 247                                                 station->tid[j].agg.rate_n_flags);
 248                         }
 249                         pos += sprintf(buf+pos, "\n");
 250                 }
 251         }
 252
 253         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
 254         kfree(buf);
 255         return ret;
 256 }
 257
 258
 259 DEBUGFS_READ_WRITE_FILE_OPS(sram);
 260 DEBUGFS_READ_FILE_OPS(stations);
 261 DEBUGFS_READ_FILE_OPS(rx_statistics);
 262 DEBUGFS_READ_FILE_OPS(tx_statistics);
 263
 264 /*
 265  * Create the debugfs files and directories
 266  *
 267  */
 268 int iwl_dbgfs_register(struct iwl_priv *priv, const char *name)
 269 {
 270         struct iwl_debugfs *dbgfs;
 271
 272         dbgfs = kzalloc(sizeof(struct iwl_debugfs), GFP_KERNEL);
 273         if (!dbgfs) {
 274                 goto err;
 275         }
 276
 277         priv->dbgfs = dbgfs;
 278         dbgfs->name = name;
 279         dbgfs->dir_drv = debugfs_create_dir(name, NULL);
 280         if (!dbgfs->dir_drv || IS_ERR(dbgfs->dir_drv)){
 281                 goto err;
 282         }
 283
 284         DEBUGFS_ADD_DIR(data, dbgfs->dir_drv);
 285         DEBUGFS_ADD_FILE(sram, data);
 286         DEBUGFS_ADD_FILE(stations, data);
 287         DEBUGFS_ADD_FILE(rx_statistics, data);
 288         DEBUGFS_ADD_FILE(tx_statistics, data);
 289
 290         return 0;
 291
 292 err:
 293         IWL_ERROR("Can't open the debugfs directory\n");
 294         iwl_dbgfs_unregister(priv);
 295         return -ENOENT;
 296 }
 297 EXPORT_SYMBOL(iwl_dbgfs_register);
 298
 299 /**
 300  * Remove the debugfs files and directories
 301  *
 302  */
 303 void iwl_dbgfs_unregister(struct iwl_priv *priv)
 304 {
 305         if (!(priv->dbgfs))
 306                 return;
 307
 308         DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_rx_statistics);
 309         DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_tx_statistics);
 310         DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_sram);
 311         DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_stations);
 312         DEBUGFS_REMOVE(priv->dbgfs->dir_data);
 313         DEBUGFS_REMOVE(priv->dbgfs->dir_drv);
 314         kfree(priv->dbgfs);
 315         priv->dbgfs = NULL;
 316 }
 317 EXPORT_SYMBOL(iwl_dbgfs_unregister);
 318
 319