drivers/staging/wfx/debug.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Debugfs interface.
   4  *
   5  * Copyright (c) 2017-2020, Silicon Laboratories, Inc.
   6  * Copyright (c) 2010, ST-Ericsson
   7  */
   8 #include <linux/debugfs.h>
   9 #include <linux/seq_file.h>
  10 #include <linux/crc32.h>
  11
  12 #include "debug.h"
  13 #include "wfx.h"
  14 #include "sta.h"
  15 #include "main.h"
  16 #include "hif_tx.h"
  17 #include "hif_tx_mib.h"
  18
  19 #define CREATE_TRACE_POINTS
  20 #include "traces.h"
  21
  22 static const struct trace_print_flags hif_msg_print_map[] = {
  23         hif_msg_list,
  24 };
  25
  26 static const struct trace_print_flags hif_mib_print_map[] = {
  27         hif_mib_list,
  28 };
  29
  30 static const struct trace_print_flags wfx_reg_print_map[] = {
  31         wfx_reg_list,
  32 };
  33
  34 static const char *get_symbol(unsigned long val,
  35                               const struct trace_print_flags *symbol_array)
  36 {
  37         int i;
  38
  39         for (i = 0; symbol_array[i].mask != -1; i++) {
  40                 if (val == symbol_array[i].mask)
  41                         return symbol_array[i].name;
  42         }
  43
  44         return "unknown";
  45 }
  46
  47 const char *get_hif_name(unsigned long id)
  48 {
  49         return get_symbol(id, hif_msg_print_map);
  50 }
  51
  52 const char *get_mib_name(unsigned long id)
  53 {
  54         return get_symbol(id, hif_mib_print_map);
  55 }
  56
  57 const char *get_reg_name(unsigned long id)
  58 {
  59         return get_symbol(id, wfx_reg_print_map);
  60 }
  61
  62 static int wfx_counters_show(struct seq_file *seq, void *v)
  63 {
  64         int ret, i;
  65         struct wfx_dev *wdev = seq->private;
  66         struct hif_mib_extended_count_table counters[3];
  67
  68         for (i = 0; i < ARRAY_SIZE(counters); i++) {
  69                 ret = hif_get_counters_table(wdev, i, counters + i);
  70                 if (ret < 0)
  71                         return ret;
  72                 if (ret > 0)
  73                         return -EIO;
  74         }
  75
  76         seq_printf(seq, "%-24s %12s %12s %12s\n",
  77                    "", "global", "iface 0", "iface 1");
  78
  79 #define PUT_COUNTER(name) \
  80         seq_printf(seq, "%-24s %12d %12d %12d\n", #name, \
  81                    le32_to_cpu(counters[2].count_##name), \
  82                    le32_to_cpu(counters[0].count_##name), \
  83                    le32_to_cpu(counters[1].count_##name))
  84
  85         PUT_COUNTER(tx_frames);
  86         PUT_COUNTER(tx_frames_multicast);
  87         PUT_COUNTER(tx_frames_success);
  88         PUT_COUNTER(tx_frames_retried);
  89         PUT_COUNTER(tx_frames_multi_retried);
  90         PUT_COUNTER(tx_frames_failed);
  91
  92         PUT_COUNTER(ack_failed);
  93         PUT_COUNTER(rts_success);
  94         PUT_COUNTER(rts_failed);
  95
  96         PUT_COUNTER(rx_frames);
  97         PUT_COUNTER(rx_frames_multicast);
  98         PUT_COUNTER(rx_frames_success);
  99         PUT_COUNTER(rx_frames_failed);
 100         PUT_COUNTER(drop_plcp);
 101         PUT_COUNTER(drop_fcs);
 102         PUT_COUNTER(drop_no_key);
 103         PUT_COUNTER(drop_decryption);
 104         PUT_COUNTER(drop_tkip_mic);
 105         PUT_COUNTER(drop_bip_mic);
 106         PUT_COUNTER(drop_cmac_icv);
 107         PUT_COUNTER(drop_cmac_replay);
 108         PUT_COUNTER(drop_ccmp_replay);
 109         PUT_COUNTER(drop_duplicate);
 110
 111         PUT_COUNTER(rx_bcn_miss);
 112         PUT_COUNTER(rx_bcn_success);
 113         PUT_COUNTER(rx_bcn_dtim);
 114         PUT_COUNTER(rx_bcn_dtim_aid0_clr);
 115         PUT_COUNTER(rx_bcn_dtim_aid0_set);
 116
 117 #undef PUT_COUNTER
 118
 119         for (i = 0; i < ARRAY_SIZE(counters[0].reserved); i++)
 120                 seq_printf(seq, "reserved[%02d]%12s %12d %12d %12d\n", i, "",
 121                            le32_to_cpu(counters[2].reserved[i]),
 122                            le32_to_cpu(counters[0].reserved[i]),
 123                            le32_to_cpu(counters[1].reserved[i]));
 124
 125         return 0;
 126 }
 127 DEFINE_SHOW_ATTRIBUTE(wfx_counters);
 128
 129 static const char * const channel_names[] = {
 130         [0] = "1M",
 131         [1] = "2M",
 132         [2] = "5.5M",
 133         [3] = "11M",
 134         /* Entries 4 and 5 does not exist */
 135         [6] = "6M",
 136         [7] = "9M",
 137         [8] = "12M",
 138         [9] = "18M",
 139         [10] = "24M",
 140         [11] = "36M",
 141         [12] = "48M",
 142         [13] = "54M",
 143         [14] = "MCS0",
 144         [15] = "MCS1",
 145         [16] = "MCS2",
 146         [17] = "MCS3",
 147         [18] = "MCS4",
 148         [19] = "MCS5",
 149         [20] = "MCS6",
 150         [21] = "MCS7",
 151 };
 152
 153 static int wfx_rx_stats_show(struct seq_file *seq, void *v)
 154 {
 155         struct wfx_dev *wdev = seq->private;
 156         struct hif_rx_stats *st = &wdev->rx_stats;
 157         int i;
 158
 159         mutex_lock(&wdev->rx_stats_lock);
 160         seq_printf(seq, "Timestamp: %dus\n", st->date);
 161         seq_printf(seq, "Low power clock: frequency %uHz, external %s\n",
 162                    le32_to_cpu(st->pwr_clk_freq),
 163                    st->is_ext_pwr_clk ? "yes" : "no");
 164         seq_printf(seq,
 165                    "Num. of frames: %d, PER (x10e4): %d, Throughput: %dKbps/s\n",
 166                    st->nb_rx_frame, st->per_total, st->throughput);
 167         seq_puts(seq, "       Num. of      PER     RSSI      SNR      CFO\n");
 168         seq_puts(seq, "        frames  (x10e4)    (dBm)     (dB)    (kHz)\n");
 169         for (i = 0; i < ARRAY_SIZE(channel_names); i++) {
 170                 if (channel_names[i])
 171                         seq_printf(seq, "%5s %8d %8d %8d %8d %8d\n",
 172                                    channel_names[i],
 173                                    le32_to_cpu(st->nb_rx_by_rate[i]),
 174                                    le16_to_cpu(st->per[i]),
 175                                    (s16)le16_to_cpu(st->rssi[i]) / 100,
 176                                    (s16)le16_to_cpu(st->snr[i]) / 100,
 177                                    (s16)le16_to_cpu(st->cfo[i]));
 178         }
 179         mutex_unlock(&wdev->rx_stats_lock);
 180
 181         return 0;
 182 }
 183 DEFINE_SHOW_ATTRIBUTE(wfx_rx_stats);
 184
 185 static int wfx_tx_power_loop_show(struct seq_file *seq, void *v)
 186 {
 187         struct wfx_dev *wdev = seq->private;
 188         struct hif_tx_power_loop_info *st = &wdev->tx_power_loop_info;
 189         int tmp;
 190
 191         mutex_lock(&wdev->tx_power_loop_info_lock);
 192         tmp = le16_to_cpu(st->tx_gain_dig);
 193         seq_printf(seq, "Tx gain digital: %d\n", tmp);
 194         tmp = le16_to_cpu(st->tx_gain_pa);
 195         seq_printf(seq, "Tx gain PA: %d\n", tmp);
 196         tmp = (s16)le16_to_cpu(st->target_pout);
 197         seq_printf(seq, "Target Pout: %d.%02d dBm\n", tmp / 4, (tmp % 4) * 25);
 198         tmp = (s16)le16_to_cpu(st->p_estimation);
 199         seq_printf(seq, "FEM Pout: %d.%02d dBm\n", tmp / 4, (tmp % 4) * 25);
 200         tmp = le16_to_cpu(st->vpdet);
 201         seq_printf(seq, "Vpdet: %d mV\n", tmp);
 202         seq_printf(seq, "Measure index: %d\n", st->measurement_index);
 203         mutex_unlock(&wdev->tx_power_loop_info_lock);
 204
 205         return 0;
 206 }
 207 DEFINE_SHOW_ATTRIBUTE(wfx_tx_power_loop);
 208
 209 static ssize_t wfx_send_pds_write(struct file *file,
 210                                   const char __user *user_buf,
 211                                   size_t count, loff_t *ppos)
 212 {
 213         struct wfx_dev *wdev = file->private_data;
 214         char *buf;
 215         int ret;
 216
 217         if (*ppos != 0) {
 218                 dev_dbg(wdev->dev, "PDS data must be written in one transaction");
 219                 return -EBUSY;
 220         }
 221         buf = memdup_user(user_buf, count);
 222         if (IS_ERR(buf))
 223                 return PTR_ERR(buf);
 224         *ppos = *ppos + count;
 225         ret = wfx_send_pds(wdev, buf, count);
 226         kfree(buf);
 227         if (ret < 0)
 228                 return ret;
 229         return count;
 230 }
 231
 232 static const struct file_operations wfx_send_pds_fops = {
 233         .open = simple_open,
 234         .write = wfx_send_pds_write,
 235 };
 236
 237 struct dbgfs_hif_msg {
 238         struct wfx_dev *wdev;
 239         struct completion complete;
 240         u8 reply[1024];
 241         int ret;
 242 };
 243
 244 static ssize_t wfx_send_hif_msg_write(struct file *file,
 245                                       const char __user *user_buf,
 246                                       size_t count, loff_t *ppos)
 247 {
 248         struct dbgfs_hif_msg *context = file->private_data;
 249         struct wfx_dev *wdev = context->wdev;
 250         struct hif_msg *request;
 251
 252         if (completion_done(&context->complete)) {
 253                 dev_dbg(wdev->dev, "read previous result before start a new one\n");
 254                 return -EBUSY;
 255         }
 256         if (count < sizeof(struct hif_msg))
 257                 return -EINVAL;
 258
 259         /* wfx_cmd_send() checks that reply buffer is wide enough, but does not
 260          * return precise length read. User have to know how many bytes should
 261          * be read. Filling reply buffer with a memory pattern may help user.
 262          */
 263         memset(context->reply, 0xFF, sizeof(context->reply));
 264         request = memdup_user(user_buf, count);
 265         if (IS_ERR(request))
 266                 return PTR_ERR(request);
 267         if (le16_to_cpu(request->len) != count) {
 268                 kfree(request);
 269                 return -EINVAL;
 270         }
 271         context->ret = wfx_cmd_send(wdev, request, context->reply,
 272                                     sizeof(context->reply), false);
 273
 274         kfree(request);
 275         complete(&context->complete);
 276         return count;
 277 }
 278
 279 static ssize_t wfx_send_hif_msg_read(struct file *file, char __user *user_buf,
 280                                      size_t count, loff_t *ppos)
 281 {
 282         struct dbgfs_hif_msg *context = file->private_data;
 283         int ret;
 284
 285         if (count > sizeof(context->reply))
 286                 return -EINVAL;
 287         ret = wait_for_completion_interruptible(&context->complete);
 288         if (ret)
 289                 return ret;
 290         if (context->ret < 0)
 291                 return context->ret;
 292         /* Be careful, write() is waiting for a full message while read()
 293          * only returns a payload
 294          */
 295         if (copy_to_user(user_buf, context->reply, count))
 296                 return -EFAULT;
 297
 298         return count;
 299 }
 300
 301 static int wfx_send_hif_msg_open(struct inode *inode, struct file *file)
 302 {
 303         struct dbgfs_hif_msg *context = kzalloc(sizeof(*context), GFP_KERNEL);
 304
 305         if (!context)
 306                 return -ENOMEM;
 307         context->wdev = inode->i_private;
 308         init_completion(&context->complete);
 309         file->private_data = context;
 310         return 0;
 311 }
 312
 313 static int wfx_send_hif_msg_release(struct inode *inode, struct file *file)
 314 {
 315         struct dbgfs_hif_msg *context = file->private_data;
 316
 317         kfree(context);
 318         return 0;
 319 }
 320
 321 static const struct file_operations wfx_send_hif_msg_fops = {
 322         .open = wfx_send_hif_msg_open,
 323         .release = wfx_send_hif_msg_release,
 324         .write = wfx_send_hif_msg_write,
 325         .read = wfx_send_hif_msg_read,
 326 };
 327
 328 static int wfx_ps_timeout_set(void *data, u64 val)
 329 {
 330         struct wfx_dev *wdev = (struct wfx_dev *)data;
 331         struct wfx_vif *wvif;
 332
 333         wdev->force_ps_timeout = val;
 334         wvif = NULL;
 335         while ((wvif = wvif_iterate(wdev, wvif)) != NULL)
 336                 wfx_update_pm(wvif);
 337         return 0;
 338 }
 339
 340 static int wfx_ps_timeout_get(void *data, u64 *val)
 341 {
 342         struct wfx_dev *wdev = (struct wfx_dev *)data;
 343
 344         *val = wdev->force_ps_timeout;
 345         return 0;
 346 }
 347
 348 DEFINE_DEBUGFS_ATTRIBUTE(wfx_ps_timeout_fops, wfx_ps_timeout_get, wfx_ps_timeout_set, "%lld\n");
 349
 350 int wfx_debug_init(struct wfx_dev *wdev)
 351 {
 352         struct dentry *d;
 353
 354         d = debugfs_create_dir("wfx", wdev->hw->wiphy->debugfsdir);
 355         debugfs_create_file("counters", 0444, d, wdev, &wfx_counters_fops);
 356         debugfs_create_file("rx_stats", 0444, d, wdev, &wfx_rx_stats_fops);
 357         debugfs_create_file("tx_power_loop", 0444, d, wdev,
 358                             &wfx_tx_power_loop_fops);
 359         debugfs_create_file("send_pds", 0200, d, wdev, &wfx_send_pds_fops);
 360         debugfs_create_file("send_hif_msg", 0600, d, wdev,
 361                             &wfx_send_hif_msg_fops);
 362         debugfs_create_file("ps_timeout", 0600, d, wdev, &wfx_ps_timeout_fops);
 363
 364         return 0;
 365 }