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