Merge tag 'mac80211-next-for-net-next-2021-06-25' of git://git.kernel.org/pub/scm...
[linux-2.6-microblaze.git] / drivers / net / wireless / intel / iwlwifi / mvm / debugfs.c
1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3  * Copyright (C) 2012-2014, 2018-2021 Intel Corporation
4  * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
5  * Copyright (C) 2016-2017 Intel Deutschland GmbH
6  */
7 #include <linux/vmalloc.h>
8 #include <linux/ieee80211.h>
9 #include <linux/netdevice.h>
10
11 #include "mvm.h"
12 #include "sta.h"
13 #include "iwl-io.h"
14 #include "debugfs.h"
15 #include "iwl-modparams.h"
16 #include "fw/error-dump.h"
17
18 static ssize_t iwl_dbgfs_ctdp_budget_read(struct file *file,
19                                           char __user *user_buf,
20                                           size_t count, loff_t *ppos)
21 {
22         struct iwl_mvm *mvm = file->private_data;
23         char buf[16];
24         int pos, budget;
25
26         if (!iwl_mvm_is_ctdp_supported(mvm))
27                 return -EOPNOTSUPP;
28
29         if (!iwl_mvm_firmware_running(mvm) ||
30             mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR)
31                 return -EIO;
32
33         mutex_lock(&mvm->mutex);
34         budget = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_REPORT, 0);
35         mutex_unlock(&mvm->mutex);
36
37         if (budget < 0)
38                 return budget;
39
40         pos = scnprintf(buf, sizeof(buf), "%d\n", budget);
41
42         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
43 }
44
45 static ssize_t iwl_dbgfs_stop_ctdp_write(struct iwl_mvm *mvm, char *buf,
46                                          size_t count, loff_t *ppos)
47 {
48         int ret;
49
50         if (!iwl_mvm_is_ctdp_supported(mvm))
51                 return -EOPNOTSUPP;
52
53         if (!iwl_mvm_firmware_running(mvm) ||
54             mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR)
55                 return -EIO;
56
57         mutex_lock(&mvm->mutex);
58         ret = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_STOP, 0);
59         mutex_unlock(&mvm->mutex);
60
61         return ret ?: count;
62 }
63
64 static ssize_t iwl_dbgfs_force_ctkill_write(struct iwl_mvm *mvm, char *buf,
65                                             size_t count, loff_t *ppos)
66 {
67         if (!iwl_mvm_firmware_running(mvm) ||
68             mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR)
69                 return -EIO;
70
71         iwl_mvm_enter_ctkill(mvm);
72
73         return count;
74 }
75
76 static ssize_t iwl_dbgfs_tx_flush_write(struct iwl_mvm *mvm, char *buf,
77                                         size_t count, loff_t *ppos)
78 {
79         int ret;
80         u32 flush_arg;
81
82         if (!iwl_mvm_firmware_running(mvm) ||
83             mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR)
84                 return -EIO;
85
86         if (kstrtou32(buf, 0, &flush_arg))
87                 return -EINVAL;
88
89         if (iwl_mvm_has_new_tx_api(mvm)) {
90                 IWL_DEBUG_TX_QUEUES(mvm,
91                                     "FLUSHING all tids queues on sta_id = %d\n",
92                                     flush_arg);
93                 mutex_lock(&mvm->mutex);
94                 ret = iwl_mvm_flush_sta_tids(mvm, flush_arg, 0xFFFF)
95                         ? : count;
96                 mutex_unlock(&mvm->mutex);
97                 return ret;
98         }
99
100         IWL_DEBUG_TX_QUEUES(mvm, "FLUSHING queues mask to flush = 0x%x\n",
101                             flush_arg);
102
103         mutex_lock(&mvm->mutex);
104         ret =  iwl_mvm_flush_tx_path(mvm, flush_arg) ? : count;
105         mutex_unlock(&mvm->mutex);
106
107         return ret;
108 }
109
110 static ssize_t iwl_dbgfs_sta_drain_write(struct iwl_mvm *mvm, char *buf,
111                                          size_t count, loff_t *ppos)
112 {
113         struct iwl_mvm_sta *mvmsta;
114         int sta_id, drain, ret;
115
116         if (!iwl_mvm_firmware_running(mvm) ||
117             mvm->fwrt.cur_fw_img != IWL_UCODE_REGULAR)
118                 return -EIO;
119
120         if (sscanf(buf, "%d %d", &sta_id, &drain) != 2)
121                 return -EINVAL;
122         if (sta_id < 0 || sta_id >= mvm->fw->ucode_capa.num_stations)
123                 return -EINVAL;
124         if (drain < 0 || drain > 1)
125                 return -EINVAL;
126
127         mutex_lock(&mvm->mutex);
128
129         mvmsta = iwl_mvm_sta_from_staid_protected(mvm, sta_id);
130
131         if (!mvmsta)
132                 ret = -ENOENT;
133         else
134                 ret = iwl_mvm_drain_sta(mvm, mvmsta, drain) ? : count;
135
136         mutex_unlock(&mvm->mutex);
137
138         return ret;
139 }
140
141 static ssize_t iwl_dbgfs_sram_read(struct file *file, char __user *user_buf,
142                                    size_t count, loff_t *ppos)
143 {
144         struct iwl_mvm *mvm = file->private_data;
145         const struct fw_img *img;
146         unsigned int ofs, len;
147         size_t ret;
148         u8 *ptr;
149
150         if (!iwl_mvm_firmware_running(mvm))
151                 return -EINVAL;
152
153         /* default is to dump the entire data segment */
154         img = &mvm->fw->img[mvm->fwrt.cur_fw_img];
155         ofs = img->sec[IWL_UCODE_SECTION_DATA].offset;
156         len = img->sec[IWL_UCODE_SECTION_DATA].len;
157
158         if (mvm->dbgfs_sram_len) {
159                 ofs = mvm->dbgfs_sram_offset;
160                 len = mvm->dbgfs_sram_len;
161         }
162
163         ptr = kzalloc(len, GFP_KERNEL);
164         if (!ptr)
165                 return -ENOMEM;
166
167         iwl_trans_read_mem_bytes(mvm->trans, ofs, ptr, len);
168
169         ret = simple_read_from_buffer(user_buf, count, ppos, ptr, len);
170
171         kfree(ptr);
172
173         return ret;
174 }
175
176 static ssize_t iwl_dbgfs_sram_write(struct iwl_mvm *mvm, char *buf,
177                                     size_t count, loff_t *ppos)
178 {
179         const struct fw_img *img;
180         u32 offset, len;
181         u32 img_offset, img_len;
182
183         if (!iwl_mvm_firmware_running(mvm))
184                 return -EINVAL;
185
186         img = &mvm->fw->img[mvm->fwrt.cur_fw_img];
187         img_offset = img->sec[IWL_UCODE_SECTION_DATA].offset;
188         img_len = img->sec[IWL_UCODE_SECTION_DATA].len;
189
190         if (sscanf(buf, "%x,%x", &offset, &len) == 2) {
191                 if ((offset & 0x3) || (len & 0x3))
192                         return -EINVAL;
193
194                 if (offset + len > img_offset + img_len)
195                         return -EINVAL;
196
197                 mvm->dbgfs_sram_offset = offset;
198                 mvm->dbgfs_sram_len = len;
199         } else {
200                 mvm->dbgfs_sram_offset = 0;
201                 mvm->dbgfs_sram_len = 0;
202         }
203
204         return count;
205 }
206
207 static ssize_t iwl_dbgfs_set_nic_temperature_read(struct file *file,
208                                                   char __user *user_buf,
209                                                   size_t count, loff_t *ppos)
210 {
211         struct iwl_mvm *mvm = file->private_data;
212         char buf[16];
213         int pos;
214
215         if (!mvm->temperature_test)
216                 pos = scnprintf(buf , sizeof(buf), "disabled\n");
217         else
218                 pos = scnprintf(buf , sizeof(buf), "%d\n", mvm->temperature);
219
220         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
221 }
222
223 /*
224  * Set NIC Temperature
225  * Cause the driver to ignore the actual NIC temperature reported by the FW
226  * Enable: any value between IWL_MVM_DEBUG_SET_TEMPERATURE_MIN -
227  * IWL_MVM_DEBUG_SET_TEMPERATURE_MAX
228  * Disable: IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE
229  */
230 static ssize_t iwl_dbgfs_set_nic_temperature_write(struct iwl_mvm *mvm,
231                                                    char *buf, size_t count,
232                                                    loff_t *ppos)
233 {
234         int temperature;
235
236         if (!iwl_mvm_firmware_running(mvm) && !mvm->temperature_test)
237                 return -EIO;
238
239         if (kstrtoint(buf, 10, &temperature))
240                 return -EINVAL;
241         /* not a legal temperature */
242         if ((temperature > IWL_MVM_DEBUG_SET_TEMPERATURE_MAX &&
243              temperature != IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) ||
244             temperature < IWL_MVM_DEBUG_SET_TEMPERATURE_MIN)
245                 return -EINVAL;
246
247         mutex_lock(&mvm->mutex);
248         if (temperature == IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) {
249                 if (!mvm->temperature_test)
250                         goto out;
251
252                 mvm->temperature_test = false;
253                 /* Since we can't read the temp while awake, just set
254                  * it to zero until we get the next RX stats from the
255                  * firmware.
256                  */
257                 mvm->temperature = 0;
258         } else {
259                 mvm->temperature_test = true;
260                 mvm->temperature = temperature;
261         }
262         IWL_DEBUG_TEMP(mvm, "%sabling debug set temperature (temp = %d)\n",
263                        mvm->temperature_test ? "En" : "Dis" ,
264                        mvm->temperature);
265         /* handle the temperature change */
266         iwl_mvm_tt_handler(mvm);
267
268 out:
269         mutex_unlock(&mvm->mutex);
270
271         return count;
272 }
273
274 static ssize_t iwl_dbgfs_nic_temp_read(struct file *file,
275                                        char __user *user_buf,
276                                        size_t count, loff_t *ppos)
277 {
278         struct iwl_mvm *mvm = file->private_data;
279         char buf[16];
280         int pos, ret;
281         s32 temp;
282
283         if (!iwl_mvm_firmware_running(mvm))
284                 return -EIO;
285
286         mutex_lock(&mvm->mutex);
287         ret = iwl_mvm_get_temp(mvm, &temp);
288         mutex_unlock(&mvm->mutex);
289
290         if (ret)
291                 return -EIO;
292
293         pos = scnprintf(buf , sizeof(buf), "%d\n", temp);
294
295         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
296 }
297
298 #ifdef CONFIG_ACPI
299 static ssize_t iwl_dbgfs_sar_geo_profile_read(struct file *file,
300                                               char __user *user_buf,
301                                               size_t count, loff_t *ppos)
302 {
303         struct iwl_mvm *mvm = file->private_data;
304         char buf[256];
305         int pos = 0;
306         int bufsz = sizeof(buf);
307         int tbl_idx;
308         u8 *value;
309
310         if (!iwl_mvm_firmware_running(mvm))
311                 return -EIO;
312
313         mutex_lock(&mvm->mutex);
314         tbl_idx = iwl_mvm_get_sar_geo_profile(mvm);
315         if (tbl_idx < 0) {
316                 mutex_unlock(&mvm->mutex);
317                 return tbl_idx;
318         }
319
320         if (!tbl_idx) {
321                 pos = scnprintf(buf, bufsz,
322                                 "SAR geographic profile disabled\n");
323         } else {
324                 value = &mvm->fwrt.geo_profiles[tbl_idx - 1].values[0];
325
326                 pos += scnprintf(buf + pos, bufsz - pos,
327                                  "Use geographic profile %d\n", tbl_idx);
328                 pos += scnprintf(buf + pos, bufsz - pos,
329                                  "2.4GHz:\n\tChain A offset: %hhu dBm\n\tChain B offset: %hhu dBm\n\tmax tx power: %hhu dBm\n",
330                                  value[1], value[2], value[0]);
331                 pos += scnprintf(buf + pos, bufsz - pos,
332                                  "5.2GHz:\n\tChain A offset: %hhu dBm\n\tChain B offset: %hhu dBm\n\tmax tx power: %hhu dBm\n",
333                                  value[4], value[5], value[3]);
334         }
335         mutex_unlock(&mvm->mutex);
336
337         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
338 }
339 #endif
340
341 static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf,
342                                        size_t count, loff_t *ppos)
343 {
344         struct iwl_mvm *mvm = file->private_data;
345         struct ieee80211_sta *sta;
346         char buf[400];
347         int i, pos = 0, bufsz = sizeof(buf);
348
349         mutex_lock(&mvm->mutex);
350
351         for (i = 0; i < mvm->fw->ucode_capa.num_stations; i++) {
352                 pos += scnprintf(buf + pos, bufsz - pos, "%.2d: ", i);
353                 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[i],
354                                                 lockdep_is_held(&mvm->mutex));
355                 if (!sta)
356                         pos += scnprintf(buf + pos, bufsz - pos, "N/A\n");
357                 else if (IS_ERR(sta))
358                         pos += scnprintf(buf + pos, bufsz - pos, "%ld\n",
359                                          PTR_ERR(sta));
360                 else
361                         pos += scnprintf(buf + pos, bufsz - pos, "%pM\n",
362                                          sta->addr);
363         }
364
365         mutex_unlock(&mvm->mutex);
366
367         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
368 }
369
370 static ssize_t iwl_dbgfs_rs_data_read(struct file *file, char __user *user_buf,
371                                       size_t count, loff_t *ppos)
372 {
373         struct ieee80211_sta *sta = file->private_data;
374         struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
375         struct iwl_lq_sta_rs_fw *lq_sta = &mvmsta->lq_sta.rs_fw;
376         struct iwl_mvm *mvm = lq_sta->pers.drv;
377         static const size_t bufsz = 2048;
378         char *buff;
379         int desc = 0;
380         ssize_t ret;
381
382         buff = kmalloc(bufsz, GFP_KERNEL);
383         if (!buff)
384                 return -ENOMEM;
385
386         mutex_lock(&mvm->mutex);
387
388         desc += scnprintf(buff + desc, bufsz - desc, "sta_id %d\n",
389                           lq_sta->pers.sta_id);
390         desc += scnprintf(buff + desc, bufsz - desc,
391                           "fixed rate 0x%X\n",
392                           lq_sta->pers.dbg_fixed_rate);
393         desc += scnprintf(buff + desc, bufsz - desc,
394                           "A-MPDU size limit %d\n",
395                           lq_sta->pers.dbg_agg_frame_count_lim);
396         desc += scnprintf(buff + desc, bufsz - desc,
397                           "valid_tx_ant %s%s%s\n",
398                 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_A) ? "ANT_A," : "",
399                 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_B) ? "ANT_B," : "",
400                 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_C) ? "ANT_C" : "");
401         desc += scnprintf(buff + desc, bufsz - desc,
402                           "last tx rate=0x%X ",
403                           lq_sta->last_rate_n_flags);
404
405         desc += rs_pretty_print_rate(buff + desc, bufsz - desc,
406                                      lq_sta->last_rate_n_flags);
407         if (desc < bufsz - 1)
408                 buff[desc++] = '\n';
409         mutex_unlock(&mvm->mutex);
410
411         ret = simple_read_from_buffer(user_buf, count, ppos, buff, desc);
412         kfree(buff);
413         return ret;
414 }
415
416 static ssize_t iwl_dbgfs_amsdu_len_write(struct ieee80211_sta *sta,
417                                          char *buf, size_t count,
418                                          loff_t *ppos)
419 {
420         struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
421         int i;
422         u16 amsdu_len;
423
424         if (kstrtou16(buf, 0, &amsdu_len))
425                 return -EINVAL;
426
427         /* only change from debug set <-> debug unset */
428         if ((amsdu_len && mvmsta->orig_amsdu_len) ||
429             (!!amsdu_len && mvmsta->orig_amsdu_len))
430                 return -EBUSY;
431
432         if (amsdu_len) {
433                 mvmsta->orig_amsdu_len = sta->max_amsdu_len;
434                 sta->max_amsdu_len = amsdu_len;
435                 for (i = 0; i < ARRAY_SIZE(sta->max_tid_amsdu_len); i++)
436                         sta->max_tid_amsdu_len[i] = amsdu_len;
437         } else {
438                 sta->max_amsdu_len = mvmsta->orig_amsdu_len;
439                 mvmsta->orig_amsdu_len = 0;
440         }
441         return count;
442 }
443
444 static ssize_t iwl_dbgfs_amsdu_len_read(struct file *file,
445                                         char __user *user_buf,
446                                         size_t count, loff_t *ppos)
447 {
448         struct ieee80211_sta *sta = file->private_data;
449         struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
450
451         char buf[32];
452         int pos;
453
454         pos = scnprintf(buf, sizeof(buf), "current %d ", sta->max_amsdu_len);
455         pos += scnprintf(buf + pos, sizeof(buf) - pos, "stored %d\n",
456                          mvmsta->orig_amsdu_len);
457
458         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
459 }
460
461 static ssize_t iwl_dbgfs_disable_power_off_read(struct file *file,
462                                                 char __user *user_buf,
463                                                 size_t count, loff_t *ppos)
464 {
465         struct iwl_mvm *mvm = file->private_data;
466         char buf[64];
467         int bufsz = sizeof(buf);
468         int pos = 0;
469
470         pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d0=%d\n",
471                          mvm->disable_power_off);
472         pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d3=%d\n",
473                          mvm->disable_power_off_d3);
474
475         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
476 }
477
478 static ssize_t iwl_dbgfs_disable_power_off_write(struct iwl_mvm *mvm, char *buf,
479                                                  size_t count, loff_t *ppos)
480 {
481         int ret, val;
482
483         if (!iwl_mvm_firmware_running(mvm))
484                 return -EIO;
485
486         if (!strncmp("disable_power_off_d0=", buf, 21)) {
487                 if (sscanf(buf + 21, "%d", &val) != 1)
488                         return -EINVAL;
489                 mvm->disable_power_off = val;
490         } else if (!strncmp("disable_power_off_d3=", buf, 21)) {
491                 if (sscanf(buf + 21, "%d", &val) != 1)
492                         return -EINVAL;
493                 mvm->disable_power_off_d3 = val;
494         } else {
495                 return -EINVAL;
496         }
497
498         mutex_lock(&mvm->mutex);
499         ret = iwl_mvm_power_update_device(mvm);
500         mutex_unlock(&mvm->mutex);
501
502         return ret ?: count;
503 }
504
505 static
506 int iwl_mvm_coex_dump_mbox(struct iwl_bt_coex_profile_notif *notif, char *buf,
507                            int pos, int bufsz)
508 {
509         pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw0:\n");
510
511         BT_MBOX_PRINT(0, LE_SLAVE_LAT, false);
512         BT_MBOX_PRINT(0, LE_PROF1, false);
513         BT_MBOX_PRINT(0, LE_PROF2, false);
514         BT_MBOX_PRINT(0, LE_PROF_OTHER, false);
515         BT_MBOX_PRINT(0, CHL_SEQ_N, false);
516         BT_MBOX_PRINT(0, INBAND_S, false);
517         BT_MBOX_PRINT(0, LE_MIN_RSSI, false);
518         BT_MBOX_PRINT(0, LE_SCAN, false);
519         BT_MBOX_PRINT(0, LE_ADV, false);
520         BT_MBOX_PRINT(0, LE_MAX_TX_POWER, false);
521         BT_MBOX_PRINT(0, OPEN_CON_1, true);
522
523         pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw1:\n");
524
525         BT_MBOX_PRINT(1, BR_MAX_TX_POWER, false);
526         BT_MBOX_PRINT(1, IP_SR, false);
527         BT_MBOX_PRINT(1, LE_MSTR, false);
528         BT_MBOX_PRINT(1, AGGR_TRFC_LD, false);
529         BT_MBOX_PRINT(1, MSG_TYPE, false);
530         BT_MBOX_PRINT(1, SSN, true);
531
532         pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw2:\n");
533
534         BT_MBOX_PRINT(2, SNIFF_ACT, false);
535         BT_MBOX_PRINT(2, PAG, false);
536         BT_MBOX_PRINT(2, INQUIRY, false);
537         BT_MBOX_PRINT(2, CONN, false);
538         BT_MBOX_PRINT(2, SNIFF_INTERVAL, false);
539         BT_MBOX_PRINT(2, DISC, false);
540         BT_MBOX_PRINT(2, SCO_TX_ACT, false);
541         BT_MBOX_PRINT(2, SCO_RX_ACT, false);
542         BT_MBOX_PRINT(2, ESCO_RE_TX, false);
543         BT_MBOX_PRINT(2, SCO_DURATION, true);
544
545         pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw3:\n");
546
547         BT_MBOX_PRINT(3, SCO_STATE, false);
548         BT_MBOX_PRINT(3, SNIFF_STATE, false);
549         BT_MBOX_PRINT(3, A2DP_STATE, false);
550         BT_MBOX_PRINT(3, A2DP_SRC, false);
551         BT_MBOX_PRINT(3, ACL_STATE, false);
552         BT_MBOX_PRINT(3, MSTR_STATE, false);
553         BT_MBOX_PRINT(3, OBX_STATE, false);
554         BT_MBOX_PRINT(3, OPEN_CON_2, false);
555         BT_MBOX_PRINT(3, TRAFFIC_LOAD, false);
556         BT_MBOX_PRINT(3, CHL_SEQN_LSB, false);
557         BT_MBOX_PRINT(3, INBAND_P, false);
558         BT_MBOX_PRINT(3, MSG_TYPE_2, false);
559         BT_MBOX_PRINT(3, SSN_2, false);
560         BT_MBOX_PRINT(3, UPDATE_REQUEST, true);
561
562         return pos;
563 }
564
565 static ssize_t iwl_dbgfs_bt_notif_read(struct file *file, char __user *user_buf,
566                                        size_t count, loff_t *ppos)
567 {
568         struct iwl_mvm *mvm = file->private_data;
569         struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;
570         char *buf;
571         int ret, pos = 0, bufsz = sizeof(char) * 1024;
572
573         buf = kmalloc(bufsz, GFP_KERNEL);
574         if (!buf)
575                 return -ENOMEM;
576
577         mutex_lock(&mvm->mutex);
578
579         pos += iwl_mvm_coex_dump_mbox(notif, buf, pos, bufsz);
580
581         pos += scnprintf(buf + pos, bufsz - pos, "bt_ci_compliance = %d\n",
582                          notif->bt_ci_compliance);
583         pos += scnprintf(buf + pos, bufsz - pos, "primary_ch_lut = %d\n",
584                          le32_to_cpu(notif->primary_ch_lut));
585         pos += scnprintf(buf + pos, bufsz - pos, "secondary_ch_lut = %d\n",
586                          le32_to_cpu(notif->secondary_ch_lut));
587         pos += scnprintf(buf + pos,
588                          bufsz - pos, "bt_activity_grading = %d\n",
589                          le32_to_cpu(notif->bt_activity_grading));
590         pos += scnprintf(buf + pos, bufsz - pos, "bt_rrc = %d\n",
591                          notif->rrc_status & 0xF);
592         pos += scnprintf(buf + pos, bufsz - pos, "bt_ttc = %d\n",
593                          notif->ttc_status & 0xF);
594
595         pos += scnprintf(buf + pos, bufsz - pos, "sync_sco = %d\n",
596                          IWL_MVM_BT_COEX_SYNC2SCO);
597         pos += scnprintf(buf + pos, bufsz - pos, "mplut = %d\n",
598                          IWL_MVM_BT_COEX_MPLUT);
599
600         mutex_unlock(&mvm->mutex);
601
602         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
603         kfree(buf);
604
605         return ret;
606 }
607 #undef BT_MBOX_PRINT
608
609 static ssize_t iwl_dbgfs_bt_cmd_read(struct file *file, char __user *user_buf,
610                                      size_t count, loff_t *ppos)
611 {
612         struct iwl_mvm *mvm = file->private_data;
613         struct iwl_bt_coex_ci_cmd *cmd = &mvm->last_bt_ci_cmd;
614         char buf[256];
615         int bufsz = sizeof(buf);
616         int pos = 0;
617
618         mutex_lock(&mvm->mutex);
619
620         pos += scnprintf(buf + pos, bufsz - pos, "Channel inhibition CMD\n");
621         pos += scnprintf(buf + pos, bufsz - pos,
622                          "\tPrimary Channel Bitmap 0x%016llx\n",
623                          le64_to_cpu(cmd->bt_primary_ci));
624         pos += scnprintf(buf + pos, bufsz - pos,
625                          "\tSecondary Channel Bitmap 0x%016llx\n",
626                          le64_to_cpu(cmd->bt_secondary_ci));
627
628         mutex_unlock(&mvm->mutex);
629
630         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
631 }
632
633 static ssize_t
634 iwl_dbgfs_bt_tx_prio_write(struct iwl_mvm *mvm, char *buf,
635                            size_t count, loff_t *ppos)
636 {
637         u32 bt_tx_prio;
638
639         if (sscanf(buf, "%u", &bt_tx_prio) != 1)
640                 return -EINVAL;
641         if (bt_tx_prio > 4)
642                 return -EINVAL;
643
644         mvm->bt_tx_prio = bt_tx_prio;
645
646         return count;
647 }
648
649 static ssize_t
650 iwl_dbgfs_bt_force_ant_write(struct iwl_mvm *mvm, char *buf,
651                              size_t count, loff_t *ppos)
652 {
653         static const char * const modes_str[BT_FORCE_ANT_MAX] = {
654                 [BT_FORCE_ANT_DIS] = "dis",
655                 [BT_FORCE_ANT_AUTO] = "auto",
656                 [BT_FORCE_ANT_BT] = "bt",
657                 [BT_FORCE_ANT_WIFI] = "wifi",
658         };
659         int ret, bt_force_ant_mode;
660
661         ret = match_string(modes_str, ARRAY_SIZE(modes_str), buf);
662         if (ret < 0)
663                 return ret;
664
665         bt_force_ant_mode = ret;
666         ret = 0;
667         mutex_lock(&mvm->mutex);
668         if (mvm->bt_force_ant_mode == bt_force_ant_mode)
669                 goto out;
670
671         mvm->bt_force_ant_mode = bt_force_ant_mode;
672         IWL_DEBUG_COEX(mvm, "Force mode: %s\n",
673                        modes_str[mvm->bt_force_ant_mode]);
674
675         if (iwl_mvm_firmware_running(mvm))
676                 ret = iwl_mvm_send_bt_init_conf(mvm);
677         else
678                 ret = 0;
679
680 out:
681         mutex_unlock(&mvm->mutex);
682         return ret ?: count;
683 }
684
685 static ssize_t iwl_dbgfs_fw_ver_read(struct file *file, char __user *user_buf,
686                                      size_t count, loff_t *ppos)
687 {
688         struct iwl_mvm *mvm = file->private_data;
689         char *buff, *pos, *endpos;
690         static const size_t bufsz = 1024;
691         int ret;
692
693         buff = kmalloc(bufsz, GFP_KERNEL);
694         if (!buff)
695                 return -ENOMEM;
696
697         pos = buff;
698         endpos = pos + bufsz;
699
700         pos += scnprintf(pos, endpos - pos, "FW prefix: %s\n",
701                          mvm->trans->cfg->fw_name_pre);
702         pos += scnprintf(pos, endpos - pos, "FW: %s\n",
703                          mvm->fwrt.fw->human_readable);
704         pos += scnprintf(pos, endpos - pos, "Device: %s\n",
705                          mvm->fwrt.trans->name);
706         pos += scnprintf(pos, endpos - pos, "Bus: %s\n",
707                          mvm->fwrt.dev->bus->name);
708
709         ret = simple_read_from_buffer(user_buf, count, ppos, buff, pos - buff);
710         kfree(buff);
711
712         return ret;
713 }
714
715 static ssize_t iwl_dbgfs_phy_integration_ver_read(struct file *file,
716                                                   char __user *user_buf,
717                                                   size_t count, loff_t *ppos)
718 {
719         struct iwl_mvm *mvm = file->private_data;
720         char *buf;
721         size_t bufsz;
722         int pos;
723         ssize_t ret;
724
725         bufsz = mvm->fw->phy_integration_ver_len + 2;
726         buf = kmalloc(bufsz, GFP_KERNEL);
727         if (!buf)
728                 return -ENOMEM;
729
730         pos = scnprintf(buf, bufsz, "%.*s\n", mvm->fw->phy_integration_ver_len,
731                         mvm->fw->phy_integration_ver);
732
733         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
734
735         kfree(buf);
736         return ret;
737 }
738
739 #define PRINT_STATS_LE32(_struct, _memb)                                \
740                          pos += scnprintf(buf + pos, bufsz - pos,       \
741                                           fmt_table, #_memb,            \
742                                           le32_to_cpu(_struct->_memb))
743
744 static ssize_t iwl_dbgfs_fw_rx_stats_read(struct file *file,
745                                           char __user *user_buf, size_t count,
746                                           loff_t *ppos)
747 {
748         struct iwl_mvm *mvm = file->private_data;
749         static const char *fmt_table = "\t%-30s %10u\n";
750         static const char *fmt_header = "%-32s\n";
751         int pos = 0;
752         char *buf;
753         int ret;
754         size_t bufsz;
755
756         if (iwl_mvm_has_new_rx_stats_api(mvm))
757                 bufsz = ((sizeof(struct mvm_statistics_rx) /
758                           sizeof(__le32)) * 43) + (4 * 33) + 1;
759         else
760                 /* 43 = size of each data line; 33 = size of each header */
761                 bufsz = ((sizeof(struct mvm_statistics_rx_v3) /
762                           sizeof(__le32)) * 43) + (4 * 33) + 1;
763
764         buf = kzalloc(bufsz, GFP_KERNEL);
765         if (!buf)
766                 return -ENOMEM;
767
768         mutex_lock(&mvm->mutex);
769
770         if (iwl_mvm_firmware_running(mvm))
771                 iwl_mvm_request_statistics(mvm, false);
772
773         pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
774                          "Statistics_Rx - OFDM");
775         if (!iwl_mvm_has_new_rx_stats_api(mvm)) {
776                 struct mvm_statistics_rx_phy_v2 *ofdm = &mvm->rx_stats_v3.ofdm;
777
778                 PRINT_STATS_LE32(ofdm, ina_cnt);
779                 PRINT_STATS_LE32(ofdm, fina_cnt);
780                 PRINT_STATS_LE32(ofdm, plcp_err);
781                 PRINT_STATS_LE32(ofdm, crc32_err);
782                 PRINT_STATS_LE32(ofdm, overrun_err);
783                 PRINT_STATS_LE32(ofdm, early_overrun_err);
784                 PRINT_STATS_LE32(ofdm, crc32_good);
785                 PRINT_STATS_LE32(ofdm, false_alarm_cnt);
786                 PRINT_STATS_LE32(ofdm, fina_sync_err_cnt);
787                 PRINT_STATS_LE32(ofdm, sfd_timeout);
788                 PRINT_STATS_LE32(ofdm, fina_timeout);
789                 PRINT_STATS_LE32(ofdm, unresponded_rts);
790                 PRINT_STATS_LE32(ofdm, rxe_frame_lmt_overrun);
791                 PRINT_STATS_LE32(ofdm, sent_ack_cnt);
792                 PRINT_STATS_LE32(ofdm, sent_cts_cnt);
793                 PRINT_STATS_LE32(ofdm, sent_ba_rsp_cnt);
794                 PRINT_STATS_LE32(ofdm, dsp_self_kill);
795                 PRINT_STATS_LE32(ofdm, mh_format_err);
796                 PRINT_STATS_LE32(ofdm, re_acq_main_rssi_sum);
797                 PRINT_STATS_LE32(ofdm, reserved);
798         } else {
799                 struct mvm_statistics_rx_phy *ofdm = &mvm->rx_stats.ofdm;
800
801                 PRINT_STATS_LE32(ofdm, unresponded_rts);
802                 PRINT_STATS_LE32(ofdm, rxe_frame_lmt_overrun);
803                 PRINT_STATS_LE32(ofdm, sent_ba_rsp_cnt);
804                 PRINT_STATS_LE32(ofdm, dsp_self_kill);
805                 PRINT_STATS_LE32(ofdm, reserved);
806         }
807
808         pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
809                          "Statistics_Rx - CCK");
810         if (!iwl_mvm_has_new_rx_stats_api(mvm)) {
811                 struct mvm_statistics_rx_phy_v2 *cck = &mvm->rx_stats_v3.cck;
812
813                 PRINT_STATS_LE32(cck, ina_cnt);
814                 PRINT_STATS_LE32(cck, fina_cnt);
815                 PRINT_STATS_LE32(cck, plcp_err);
816                 PRINT_STATS_LE32(cck, crc32_err);
817                 PRINT_STATS_LE32(cck, overrun_err);
818                 PRINT_STATS_LE32(cck, early_overrun_err);
819                 PRINT_STATS_LE32(cck, crc32_good);
820                 PRINT_STATS_LE32(cck, false_alarm_cnt);
821                 PRINT_STATS_LE32(cck, fina_sync_err_cnt);
822                 PRINT_STATS_LE32(cck, sfd_timeout);
823                 PRINT_STATS_LE32(cck, fina_timeout);
824                 PRINT_STATS_LE32(cck, unresponded_rts);
825                 PRINT_STATS_LE32(cck, rxe_frame_lmt_overrun);
826                 PRINT_STATS_LE32(cck, sent_ack_cnt);
827                 PRINT_STATS_LE32(cck, sent_cts_cnt);
828                 PRINT_STATS_LE32(cck, sent_ba_rsp_cnt);
829                 PRINT_STATS_LE32(cck, dsp_self_kill);
830                 PRINT_STATS_LE32(cck, mh_format_err);
831                 PRINT_STATS_LE32(cck, re_acq_main_rssi_sum);
832                 PRINT_STATS_LE32(cck, reserved);
833         } else {
834                 struct mvm_statistics_rx_phy *cck = &mvm->rx_stats.cck;
835
836                 PRINT_STATS_LE32(cck, unresponded_rts);
837                 PRINT_STATS_LE32(cck, rxe_frame_lmt_overrun);
838                 PRINT_STATS_LE32(cck, sent_ba_rsp_cnt);
839                 PRINT_STATS_LE32(cck, dsp_self_kill);
840                 PRINT_STATS_LE32(cck, reserved);
841         }
842
843         pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
844                          "Statistics_Rx - GENERAL");
845         if (!iwl_mvm_has_new_rx_stats_api(mvm)) {
846                 struct mvm_statistics_rx_non_phy_v3 *general =
847                         &mvm->rx_stats_v3.general;
848
849                 PRINT_STATS_LE32(general, bogus_cts);
850                 PRINT_STATS_LE32(general, bogus_ack);
851                 PRINT_STATS_LE32(general, non_bssid_frames);
852                 PRINT_STATS_LE32(general, filtered_frames);
853                 PRINT_STATS_LE32(general, non_channel_beacons);
854                 PRINT_STATS_LE32(general, channel_beacons);
855                 PRINT_STATS_LE32(general, num_missed_bcon);
856                 PRINT_STATS_LE32(general, adc_rx_saturation_time);
857                 PRINT_STATS_LE32(general, ina_detection_search_time);
858                 PRINT_STATS_LE32(general, beacon_silence_rssi_a);
859                 PRINT_STATS_LE32(general, beacon_silence_rssi_b);
860                 PRINT_STATS_LE32(general, beacon_silence_rssi_c);
861                 PRINT_STATS_LE32(general, interference_data_flag);
862                 PRINT_STATS_LE32(general, channel_load);
863                 PRINT_STATS_LE32(general, dsp_false_alarms);
864                 PRINT_STATS_LE32(general, beacon_rssi_a);
865                 PRINT_STATS_LE32(general, beacon_rssi_b);
866                 PRINT_STATS_LE32(general, beacon_rssi_c);
867                 PRINT_STATS_LE32(general, beacon_energy_a);
868                 PRINT_STATS_LE32(general, beacon_energy_b);
869                 PRINT_STATS_LE32(general, beacon_energy_c);
870                 PRINT_STATS_LE32(general, num_bt_kills);
871                 PRINT_STATS_LE32(general, mac_id);
872                 PRINT_STATS_LE32(general, directed_data_mpdu);
873         } else {
874                 struct mvm_statistics_rx_non_phy *general =
875                         &mvm->rx_stats.general;
876
877                 PRINT_STATS_LE32(general, bogus_cts);
878                 PRINT_STATS_LE32(general, bogus_ack);
879                 PRINT_STATS_LE32(general, non_channel_beacons);
880                 PRINT_STATS_LE32(general, channel_beacons);
881                 PRINT_STATS_LE32(general, num_missed_bcon);
882                 PRINT_STATS_LE32(general, adc_rx_saturation_time);
883                 PRINT_STATS_LE32(general, ina_detection_search_time);
884                 PRINT_STATS_LE32(general, beacon_silence_rssi_a);
885                 PRINT_STATS_LE32(general, beacon_silence_rssi_b);
886                 PRINT_STATS_LE32(general, beacon_silence_rssi_c);
887                 PRINT_STATS_LE32(general, interference_data_flag);
888                 PRINT_STATS_LE32(general, channel_load);
889                 PRINT_STATS_LE32(general, beacon_rssi_a);
890                 PRINT_STATS_LE32(general, beacon_rssi_b);
891                 PRINT_STATS_LE32(general, beacon_rssi_c);
892                 PRINT_STATS_LE32(general, beacon_energy_a);
893                 PRINT_STATS_LE32(general, beacon_energy_b);
894                 PRINT_STATS_LE32(general, beacon_energy_c);
895                 PRINT_STATS_LE32(general, num_bt_kills);
896                 PRINT_STATS_LE32(general, mac_id);
897         }
898
899         pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
900                          "Statistics_Rx - HT");
901         if (!iwl_mvm_has_new_rx_stats_api(mvm)) {
902                 struct mvm_statistics_rx_ht_phy_v1 *ht =
903                         &mvm->rx_stats_v3.ofdm_ht;
904
905                 PRINT_STATS_LE32(ht, plcp_err);
906                 PRINT_STATS_LE32(ht, overrun_err);
907                 PRINT_STATS_LE32(ht, early_overrun_err);
908                 PRINT_STATS_LE32(ht, crc32_good);
909                 PRINT_STATS_LE32(ht, crc32_err);
910                 PRINT_STATS_LE32(ht, mh_format_err);
911                 PRINT_STATS_LE32(ht, agg_crc32_good);
912                 PRINT_STATS_LE32(ht, agg_mpdu_cnt);
913                 PRINT_STATS_LE32(ht, agg_cnt);
914                 PRINT_STATS_LE32(ht, unsupport_mcs);
915         } else {
916                 struct mvm_statistics_rx_ht_phy *ht =
917                         &mvm->rx_stats.ofdm_ht;
918
919                 PRINT_STATS_LE32(ht, mh_format_err);
920                 PRINT_STATS_LE32(ht, agg_mpdu_cnt);
921                 PRINT_STATS_LE32(ht, agg_cnt);
922                 PRINT_STATS_LE32(ht, unsupport_mcs);
923         }
924
925         mutex_unlock(&mvm->mutex);
926
927         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
928         kfree(buf);
929
930         return ret;
931 }
932 #undef PRINT_STAT_LE32
933
934 static ssize_t iwl_dbgfs_frame_stats_read(struct iwl_mvm *mvm,
935                                           char __user *user_buf, size_t count,
936                                           loff_t *ppos,
937                                           struct iwl_mvm_frame_stats *stats)
938 {
939         char *buff, *pos, *endpos;
940         int idx, i;
941         int ret;
942         static const size_t bufsz = 1024;
943
944         buff = kmalloc(bufsz, GFP_KERNEL);
945         if (!buff)
946                 return -ENOMEM;
947
948         spin_lock_bh(&mvm->drv_stats_lock);
949
950         pos = buff;
951         endpos = pos + bufsz;
952
953         pos += scnprintf(pos, endpos - pos,
954                          "Legacy/HT/VHT\t:\t%d/%d/%d\n",
955                          stats->legacy_frames,
956                          stats->ht_frames,
957                          stats->vht_frames);
958         pos += scnprintf(pos, endpos - pos, "20/40/80\t:\t%d/%d/%d\n",
959                          stats->bw_20_frames,
960                          stats->bw_40_frames,
961                          stats->bw_80_frames);
962         pos += scnprintf(pos, endpos - pos, "NGI/SGI\t\t:\t%d/%d\n",
963                          stats->ngi_frames,
964                          stats->sgi_frames);
965         pos += scnprintf(pos, endpos - pos, "SISO/MIMO2\t:\t%d/%d\n",
966                          stats->siso_frames,
967                          stats->mimo2_frames);
968         pos += scnprintf(pos, endpos - pos, "FAIL/SCSS\t:\t%d/%d\n",
969                          stats->fail_frames,
970                          stats->success_frames);
971         pos += scnprintf(pos, endpos - pos, "MPDUs agg\t:\t%d\n",
972                          stats->agg_frames);
973         pos += scnprintf(pos, endpos - pos, "A-MPDUs\t\t:\t%d\n",
974                          stats->ampdu_count);
975         pos += scnprintf(pos, endpos - pos, "Avg MPDUs/A-MPDU:\t%d\n",
976                          stats->ampdu_count > 0 ?
977                          (stats->agg_frames / stats->ampdu_count) : 0);
978
979         pos += scnprintf(pos, endpos - pos, "Last Rates\n");
980
981         idx = stats->last_frame_idx - 1;
982         for (i = 0; i < ARRAY_SIZE(stats->last_rates); i++) {
983                 idx = (idx + 1) % ARRAY_SIZE(stats->last_rates);
984                 if (stats->last_rates[idx] == 0)
985                         continue;
986                 pos += scnprintf(pos, endpos - pos, "Rate[%d]: ",
987                                  (int)(ARRAY_SIZE(stats->last_rates) - i));
988                 pos += rs_pretty_print_rate(pos, endpos - pos,
989                                             stats->last_rates[idx]);
990                 if (pos < endpos - 1)
991                         *pos++ = '\n';
992         }
993         spin_unlock_bh(&mvm->drv_stats_lock);
994
995         ret = simple_read_from_buffer(user_buf, count, ppos, buff, pos - buff);
996         kfree(buff);
997
998         return ret;
999 }
1000
1001 static ssize_t iwl_dbgfs_drv_rx_stats_read(struct file *file,
1002                                            char __user *user_buf, size_t count,
1003                                            loff_t *ppos)
1004 {
1005         struct iwl_mvm *mvm = file->private_data;
1006
1007         return iwl_dbgfs_frame_stats_read(mvm, user_buf, count, ppos,
1008                                           &mvm->drv_rx_stats);
1009 }
1010
1011 static ssize_t iwl_dbgfs_fw_restart_write(struct iwl_mvm *mvm, char *buf,
1012                                           size_t count, loff_t *ppos)
1013 {
1014         int __maybe_unused ret;
1015
1016         if (!iwl_mvm_firmware_running(mvm))
1017                 return -EIO;
1018
1019         mutex_lock(&mvm->mutex);
1020
1021         /* allow one more restart that we're provoking here */
1022         if (mvm->fw_restart >= 0)
1023                 mvm->fw_restart++;
1024
1025         /* take the return value to make compiler happy - it will fail anyway */
1026         ret = iwl_mvm_send_cmd_pdu(mvm,
1027                                    WIDE_ID(LONG_GROUP, REPLY_ERROR),
1028                                    0, 0, NULL);
1029
1030         mutex_unlock(&mvm->mutex);
1031
1032         return count;
1033 }
1034
1035 static ssize_t iwl_dbgfs_fw_nmi_write(struct iwl_mvm *mvm, char *buf,
1036                                       size_t count, loff_t *ppos)
1037 {
1038         if (!iwl_mvm_firmware_running(mvm))
1039                 return -EIO;
1040
1041         iwl_force_nmi(mvm->trans);
1042
1043         return count;
1044 }
1045
1046 static ssize_t
1047 iwl_dbgfs_scan_ant_rxchain_read(struct file *file,
1048                                 char __user *user_buf,
1049                                 size_t count, loff_t *ppos)
1050 {
1051         struct iwl_mvm *mvm = file->private_data;
1052         int pos = 0;
1053         char buf[32];
1054         const size_t bufsz = sizeof(buf);
1055
1056         /* print which antennas were set for the scan command by the user */
1057         pos += scnprintf(buf + pos, bufsz - pos, "Antennas for scan: ");
1058         if (mvm->scan_rx_ant & ANT_A)
1059                 pos += scnprintf(buf + pos, bufsz - pos, "A");
1060         if (mvm->scan_rx_ant & ANT_B)
1061                 pos += scnprintf(buf + pos, bufsz - pos, "B");
1062         if (mvm->scan_rx_ant & ANT_C)
1063                 pos += scnprintf(buf + pos, bufsz - pos, "C");
1064         pos += scnprintf(buf + pos, bufsz - pos, " (%hhx)\n", mvm->scan_rx_ant);
1065
1066         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1067 }
1068
1069 static ssize_t
1070 iwl_dbgfs_scan_ant_rxchain_write(struct iwl_mvm *mvm, char *buf,
1071                                  size_t count, loff_t *ppos)
1072 {
1073         u8 scan_rx_ant;
1074
1075         if (!iwl_mvm_firmware_running(mvm))
1076                 return -EIO;
1077
1078         if (sscanf(buf, "%hhx", &scan_rx_ant) != 1)
1079                 return -EINVAL;
1080         if (scan_rx_ant > ANT_ABC)
1081                 return -EINVAL;
1082         if (scan_rx_ant & ~(iwl_mvm_get_valid_rx_ant(mvm)))
1083                 return -EINVAL;
1084
1085         if (mvm->scan_rx_ant != scan_rx_ant) {
1086                 mvm->scan_rx_ant = scan_rx_ant;
1087                 if (fw_has_capa(&mvm->fw->ucode_capa,
1088                                 IWL_UCODE_TLV_CAPA_UMAC_SCAN))
1089                         iwl_mvm_config_scan(mvm);
1090         }
1091
1092         return count;
1093 }
1094
1095 static ssize_t iwl_dbgfs_indirection_tbl_write(struct iwl_mvm *mvm,
1096                                                char *buf, size_t count,
1097                                                loff_t *ppos)
1098 {
1099         struct iwl_rss_config_cmd cmd = {
1100                 .flags = cpu_to_le32(IWL_RSS_ENABLE),
1101                 .hash_mask = IWL_RSS_HASH_TYPE_IPV4_TCP |
1102                              IWL_RSS_HASH_TYPE_IPV4_UDP |
1103                              IWL_RSS_HASH_TYPE_IPV4_PAYLOAD |
1104                              IWL_RSS_HASH_TYPE_IPV6_TCP |
1105                              IWL_RSS_HASH_TYPE_IPV6_UDP |
1106                              IWL_RSS_HASH_TYPE_IPV6_PAYLOAD,
1107         };
1108         int ret, i, num_repeats, nbytes = count / 2;
1109
1110         ret = hex2bin(cmd.indirection_table, buf, nbytes);
1111         if (ret)
1112                 return ret;
1113
1114         /*
1115          * The input is the redirection table, partial or full.
1116          * Repeat the pattern if needed.
1117          * For example, input of 01020F will be repeated 42 times,
1118          * indirecting RSS hash results to queues 1, 2, 15 (skipping
1119          * queues 3 - 14).
1120          */
1121         num_repeats = ARRAY_SIZE(cmd.indirection_table) / nbytes;
1122         for (i = 1; i < num_repeats; i++)
1123                 memcpy(&cmd.indirection_table[i * nbytes],
1124                        cmd.indirection_table, nbytes);
1125         /* handle cut in the middle pattern for the last places */
1126         memcpy(&cmd.indirection_table[i * nbytes], cmd.indirection_table,
1127                ARRAY_SIZE(cmd.indirection_table) % nbytes);
1128
1129         netdev_rss_key_fill(cmd.secret_key, sizeof(cmd.secret_key));
1130
1131         mutex_lock(&mvm->mutex);
1132         if (iwl_mvm_firmware_running(mvm))
1133                 ret = iwl_mvm_send_cmd_pdu(mvm, RSS_CONFIG_CMD, 0,
1134                                            sizeof(cmd), &cmd);
1135         else
1136                 ret = 0;
1137         mutex_unlock(&mvm->mutex);
1138
1139         return ret ?: count;
1140 }
1141
1142 static ssize_t iwl_dbgfs_inject_packet_write(struct iwl_mvm *mvm,
1143                                              char *buf, size_t count,
1144                                              loff_t *ppos)
1145 {
1146         struct iwl_op_mode *opmode = container_of((void *)mvm,
1147                                                   struct iwl_op_mode,
1148                                                   op_mode_specific);
1149         struct iwl_rx_cmd_buffer rxb = {
1150                 ._rx_page_order = 0,
1151                 .truesize = 0, /* not used */
1152                 ._offset = 0,
1153         };
1154         struct iwl_rx_packet *pkt;
1155         int bin_len = count / 2;
1156         int ret = -EINVAL;
1157
1158         if (!iwl_mvm_firmware_running(mvm))
1159                 return -EIO;
1160
1161         /* supporting only MQ RX */
1162         if (!mvm->trans->trans_cfg->mq_rx_supported)
1163                 return -ENOTSUPP;
1164
1165         rxb._page = alloc_pages(GFP_ATOMIC, 0);
1166         if (!rxb._page)
1167                 return -ENOMEM;
1168         pkt = rxb_addr(&rxb);
1169
1170         ret = hex2bin(page_address(rxb._page), buf, bin_len);
1171         if (ret)
1172                 goto out;
1173
1174         /* avoid invalid memory access and malformed packet */
1175         if (bin_len < sizeof(*pkt) ||
1176             bin_len != sizeof(*pkt) + iwl_rx_packet_payload_len(pkt))
1177                 goto out;
1178
1179         local_bh_disable();
1180         iwl_mvm_rx_mq(opmode, NULL, &rxb);
1181         local_bh_enable();
1182         ret = 0;
1183
1184 out:
1185         iwl_free_rxb(&rxb);
1186
1187         return ret ?: count;
1188 }
1189
1190 static int _iwl_dbgfs_inject_beacon_ie(struct iwl_mvm *mvm, char *bin, int len)
1191 {
1192         struct ieee80211_vif *vif;
1193         struct iwl_mvm_vif *mvmvif;
1194         struct sk_buff *beacon;
1195         struct ieee80211_tx_info *info;
1196         struct iwl_mac_beacon_cmd beacon_cmd = {};
1197         u8 rate;
1198         u16 flags;
1199         int i;
1200
1201         len /= 2;
1202
1203         /* Element len should be represented by u8 */
1204         if (len >= U8_MAX)
1205                 return -EINVAL;
1206
1207         if (!iwl_mvm_firmware_running(mvm))
1208                 return -EIO;
1209
1210         if (!iwl_mvm_has_new_tx_api(mvm) &&
1211             !fw_has_api(&mvm->fw->ucode_capa,
1212                         IWL_UCODE_TLV_API_NEW_BEACON_TEMPLATE))
1213                 return -EINVAL;
1214
1215         mutex_lock(&mvm->mutex);
1216
1217         for (i = 0; i < NUM_MAC_INDEX_DRIVER; i++) {
1218                 vif = iwl_mvm_rcu_dereference_vif_id(mvm, i, false);
1219                 if (!vif)
1220                         continue;
1221
1222                 if (vif->type == NL80211_IFTYPE_AP)
1223                         break;
1224         }
1225
1226         if (i == NUM_MAC_INDEX_DRIVER || !vif)
1227                 goto out_err;
1228
1229         mvm->hw->extra_beacon_tailroom = len;
1230
1231         beacon = ieee80211_beacon_get_template(mvm->hw, vif, NULL);
1232         if (!beacon)
1233                 goto out_err;
1234
1235         if (len && hex2bin(skb_put_zero(beacon, len), bin, len)) {
1236                 dev_kfree_skb(beacon);
1237                 goto out_err;
1238         }
1239
1240         mvm->beacon_inject_active = true;
1241
1242         mvmvif = iwl_mvm_vif_from_mac80211(vif);
1243         info = IEEE80211_SKB_CB(beacon);
1244         rate = iwl_mvm_mac_ctxt_get_lowest_rate(info, vif);
1245         flags = iwl_mvm_mac80211_idx_to_hwrate(rate);
1246
1247         if (rate == IWL_FIRST_CCK_RATE)
1248                 flags |= IWL_MAC_BEACON_CCK;
1249
1250         beacon_cmd.flags = cpu_to_le16(flags);
1251         beacon_cmd.byte_cnt = cpu_to_le16((u16)beacon->len);
1252         beacon_cmd.template_id = cpu_to_le32((u32)mvmvif->id);
1253
1254         iwl_mvm_mac_ctxt_set_tim(mvm, &beacon_cmd.tim_idx,
1255                                  &beacon_cmd.tim_size,
1256                                  beacon->data, beacon->len);
1257
1258         iwl_mvm_mac_ctxt_send_beacon_cmd(mvm, beacon, &beacon_cmd,
1259                                          sizeof(beacon_cmd));
1260         mutex_unlock(&mvm->mutex);
1261
1262         dev_kfree_skb(beacon);
1263
1264         return 0;
1265
1266 out_err:
1267         mutex_unlock(&mvm->mutex);
1268         return -EINVAL;
1269 }
1270
1271 static ssize_t iwl_dbgfs_inject_beacon_ie_write(struct iwl_mvm *mvm,
1272                                                 char *buf, size_t count,
1273                                                 loff_t *ppos)
1274 {
1275         int ret = _iwl_dbgfs_inject_beacon_ie(mvm, buf, count);
1276
1277         mvm->hw->extra_beacon_tailroom = 0;
1278         return ret ?: count;
1279 }
1280
1281 static ssize_t iwl_dbgfs_inject_beacon_ie_restore_write(struct iwl_mvm *mvm,
1282                                                         char *buf,
1283                                                         size_t count,
1284                                                         loff_t *ppos)
1285 {
1286         int ret = _iwl_dbgfs_inject_beacon_ie(mvm, NULL, 0);
1287
1288         mvm->hw->extra_beacon_tailroom = 0;
1289         mvm->beacon_inject_active = false;
1290         return ret ?: count;
1291 }
1292
1293 static ssize_t iwl_dbgfs_fw_dbg_conf_read(struct file *file,
1294                                           char __user *user_buf,
1295                                           size_t count, loff_t *ppos)
1296 {
1297         struct iwl_mvm *mvm = file->private_data;
1298         int conf;
1299         char buf[8];
1300         const size_t bufsz = sizeof(buf);
1301         int pos = 0;
1302
1303         mutex_lock(&mvm->mutex);
1304         conf = mvm->fwrt.dump.conf;
1305         mutex_unlock(&mvm->mutex);
1306
1307         pos += scnprintf(buf + pos, bufsz - pos, "%d\n", conf);
1308
1309         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1310 }
1311
1312 static ssize_t iwl_dbgfs_fw_dbg_conf_write(struct iwl_mvm *mvm,
1313                                            char *buf, size_t count,
1314                                            loff_t *ppos)
1315 {
1316         unsigned int conf_id;
1317         int ret;
1318
1319         if (!iwl_mvm_firmware_running(mvm))
1320                 return -EIO;
1321
1322         ret = kstrtouint(buf, 0, &conf_id);
1323         if (ret)
1324                 return ret;
1325
1326         if (WARN_ON(conf_id >= FW_DBG_CONF_MAX))
1327                 return -EINVAL;
1328
1329         mutex_lock(&mvm->mutex);
1330         ret = iwl_fw_start_dbg_conf(&mvm->fwrt, conf_id);
1331         mutex_unlock(&mvm->mutex);
1332
1333         return ret ?: count;
1334 }
1335
1336 static ssize_t iwl_dbgfs_fw_dbg_collect_write(struct iwl_mvm *mvm,
1337                                               char *buf, size_t count,
1338                                               loff_t *ppos)
1339 {
1340         if (count == 0)
1341                 return 0;
1342
1343         iwl_dbg_tlv_time_point(&mvm->fwrt, IWL_FW_INI_TIME_POINT_USER_TRIGGER,
1344                                NULL);
1345
1346         iwl_fw_dbg_collect(&mvm->fwrt, FW_DBG_TRIGGER_USER, buf,
1347                            (count - 1), NULL);
1348
1349         return count;
1350 }
1351
1352 static ssize_t iwl_dbgfs_dbg_time_point_write(struct iwl_mvm *mvm,
1353                                               char *buf, size_t count,
1354                                               loff_t *ppos)
1355 {
1356         u32 timepoint;
1357
1358         if (kstrtou32(buf, 0, &timepoint))
1359                 return -EINVAL;
1360
1361         if (timepoint == IWL_FW_INI_TIME_POINT_INVALID ||
1362             timepoint >= IWL_FW_INI_TIME_POINT_NUM)
1363                 return -EINVAL;
1364
1365         iwl_dbg_tlv_time_point(&mvm->fwrt, timepoint, NULL);
1366
1367         return count;
1368 }
1369
1370 #define ADD_TEXT(...) pos += scnprintf(buf + pos, bufsz - pos, __VA_ARGS__)
1371 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1372 static ssize_t iwl_dbgfs_bcast_filters_read(struct file *file,
1373                                             char __user *user_buf,
1374                                             size_t count, loff_t *ppos)
1375 {
1376         struct iwl_mvm *mvm = file->private_data;
1377         struct iwl_bcast_filter_cmd cmd;
1378         const struct iwl_fw_bcast_filter *filter;
1379         char *buf;
1380         int bufsz = 1024;
1381         int i, j, pos = 0;
1382         ssize_t ret;
1383
1384         buf = kzalloc(bufsz, GFP_KERNEL);
1385         if (!buf)
1386                 return -ENOMEM;
1387
1388         mutex_lock(&mvm->mutex);
1389         if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1390                 ADD_TEXT("None\n");
1391                 mutex_unlock(&mvm->mutex);
1392                 goto out;
1393         }
1394         mutex_unlock(&mvm->mutex);
1395
1396         for (i = 0; cmd.filters[i].attrs[0].mask; i++) {
1397                 filter = &cmd.filters[i];
1398
1399                 ADD_TEXT("Filter [%d]:\n", i);
1400                 ADD_TEXT("\tDiscard=%d\n", filter->discard);
1401                 ADD_TEXT("\tFrame Type: %s\n",
1402                          filter->frame_type ? "IPv4" : "Generic");
1403
1404                 for (j = 0; j < ARRAY_SIZE(filter->attrs); j++) {
1405                         const struct iwl_fw_bcast_filter_attr *attr;
1406
1407                         attr = &filter->attrs[j];
1408                         if (!attr->mask)
1409                                 break;
1410
1411                         ADD_TEXT("\tAttr [%d]: offset=%d (from %s), mask=0x%x, value=0x%x reserved=0x%x\n",
1412                                  j, attr->offset,
1413                                  attr->offset_type ? "IP End" :
1414                                                      "Payload Start",
1415                                  be32_to_cpu(attr->mask),
1416                                  be32_to_cpu(attr->val),
1417                                  le16_to_cpu(attr->reserved1));
1418                 }
1419         }
1420 out:
1421         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1422         kfree(buf);
1423         return ret;
1424 }
1425
1426 static ssize_t iwl_dbgfs_bcast_filters_write(struct iwl_mvm *mvm, char *buf,
1427                                              size_t count, loff_t *ppos)
1428 {
1429         int pos, next_pos;
1430         struct iwl_fw_bcast_filter filter = {};
1431         struct iwl_bcast_filter_cmd cmd;
1432         u32 filter_id, attr_id, mask, value;
1433         int err = 0;
1434
1435         if (sscanf(buf, "%d %hhi %hhi %n", &filter_id, &filter.discard,
1436                    &filter.frame_type, &pos) != 3)
1437                 return -EINVAL;
1438
1439         if (filter_id >= ARRAY_SIZE(mvm->dbgfs_bcast_filtering.cmd.filters) ||
1440             filter.frame_type > BCAST_FILTER_FRAME_TYPE_IPV4)
1441                 return -EINVAL;
1442
1443         for (attr_id = 0; attr_id < ARRAY_SIZE(filter.attrs);
1444              attr_id++) {
1445                 struct iwl_fw_bcast_filter_attr *attr =
1446                                 &filter.attrs[attr_id];
1447
1448                 if (pos >= count)
1449                         break;
1450
1451                 if (sscanf(&buf[pos], "%hhi %hhi %i %i %n",
1452                            &attr->offset, &attr->offset_type,
1453                            &mask, &value, &next_pos) != 4)
1454                         return -EINVAL;
1455
1456                 attr->mask = cpu_to_be32(mask);
1457                 attr->val = cpu_to_be32(value);
1458                 if (mask)
1459                         filter.num_attrs++;
1460
1461                 pos += next_pos;
1462         }
1463
1464         mutex_lock(&mvm->mutex);
1465         memcpy(&mvm->dbgfs_bcast_filtering.cmd.filters[filter_id],
1466                &filter, sizeof(filter));
1467
1468         /* send updated bcast filtering configuration */
1469         if (iwl_mvm_firmware_running(mvm) &&
1470             mvm->dbgfs_bcast_filtering.override &&
1471             iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1472                 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1473                                            sizeof(cmd), &cmd);
1474         mutex_unlock(&mvm->mutex);
1475
1476         return err ?: count;
1477 }
1478
1479 static ssize_t iwl_dbgfs_bcast_filters_macs_read(struct file *file,
1480                                                  char __user *user_buf,
1481                                                  size_t count, loff_t *ppos)
1482 {
1483         struct iwl_mvm *mvm = file->private_data;
1484         struct iwl_bcast_filter_cmd cmd;
1485         char *buf;
1486         int bufsz = 1024;
1487         int i, pos = 0;
1488         ssize_t ret;
1489
1490         buf = kzalloc(bufsz, GFP_KERNEL);
1491         if (!buf)
1492                 return -ENOMEM;
1493
1494         mutex_lock(&mvm->mutex);
1495         if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1496                 ADD_TEXT("None\n");
1497                 mutex_unlock(&mvm->mutex);
1498                 goto out;
1499         }
1500         mutex_unlock(&mvm->mutex);
1501
1502         for (i = 0; i < ARRAY_SIZE(cmd.macs); i++) {
1503                 const struct iwl_fw_bcast_mac *mac = &cmd.macs[i];
1504
1505                 ADD_TEXT("Mac [%d]: discard=%d attached_filters=0x%x\n",
1506                          i, mac->default_discard, mac->attached_filters);
1507         }
1508 out:
1509         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1510         kfree(buf);
1511         return ret;
1512 }
1513
1514 static ssize_t iwl_dbgfs_bcast_filters_macs_write(struct iwl_mvm *mvm,
1515                                                   char *buf, size_t count,
1516                                                   loff_t *ppos)
1517 {
1518         struct iwl_bcast_filter_cmd cmd;
1519         struct iwl_fw_bcast_mac mac = {};
1520         u32 mac_id, attached_filters;
1521         int err = 0;
1522
1523         if (!mvm->bcast_filters)
1524                 return -ENOENT;
1525
1526         if (sscanf(buf, "%d %hhi %i", &mac_id, &mac.default_discard,
1527                    &attached_filters) != 3)
1528                 return -EINVAL;
1529
1530         if (mac_id >= ARRAY_SIZE(cmd.macs) ||
1531             mac.default_discard > 1 ||
1532             attached_filters >= BIT(ARRAY_SIZE(cmd.filters)))
1533                 return -EINVAL;
1534
1535         mac.attached_filters = cpu_to_le16(attached_filters);
1536
1537         mutex_lock(&mvm->mutex);
1538         memcpy(&mvm->dbgfs_bcast_filtering.cmd.macs[mac_id],
1539                &mac, sizeof(mac));
1540
1541         /* send updated bcast filtering configuration */
1542         if (iwl_mvm_firmware_running(mvm) &&
1543             mvm->dbgfs_bcast_filtering.override &&
1544             iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1545                 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1546                                            sizeof(cmd), &cmd);
1547         mutex_unlock(&mvm->mutex);
1548
1549         return err ?: count;
1550 }
1551 #endif
1552
1553 #define MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
1554         _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1555 #define MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
1556         _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1557 #define MVM_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do {      \
1558                 debugfs_create_file(alias, mode, parent, mvm,           \
1559                                     &iwl_dbgfs_##name##_ops);           \
1560         } while (0)
1561 #define MVM_DEBUGFS_ADD_FILE(name, parent, mode) \
1562         MVM_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
1563
1564 #define MVM_DEBUGFS_WRITE_STA_FILE_OPS(name, bufsz) \
1565         _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct ieee80211_sta)
1566 #define MVM_DEBUGFS_READ_WRITE_STA_FILE_OPS(name, bufsz) \
1567         _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct ieee80211_sta)
1568
1569 #define MVM_DEBUGFS_ADD_STA_FILE_ALIAS(alias, name, parent, mode) do {  \
1570                 debugfs_create_file(alias, mode, parent, sta,           \
1571                                     &iwl_dbgfs_##name##_ops);           \
1572         } while (0)
1573 #define MVM_DEBUGFS_ADD_STA_FILE(name, parent, mode) \
1574         MVM_DEBUGFS_ADD_STA_FILE_ALIAS(#name, name, parent, mode)
1575
1576 static ssize_t
1577 iwl_dbgfs_prph_reg_read(struct file *file,
1578                         char __user *user_buf,
1579                         size_t count, loff_t *ppos)
1580 {
1581         struct iwl_mvm *mvm = file->private_data;
1582         int pos = 0;
1583         char buf[32];
1584         const size_t bufsz = sizeof(buf);
1585
1586         if (!mvm->dbgfs_prph_reg_addr)
1587                 return -EINVAL;
1588
1589         pos += scnprintf(buf + pos, bufsz - pos, "Reg 0x%x: (0x%x)\n",
1590                 mvm->dbgfs_prph_reg_addr,
1591                 iwl_read_prph(mvm->trans, mvm->dbgfs_prph_reg_addr));
1592
1593         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1594 }
1595
1596 static ssize_t
1597 iwl_dbgfs_prph_reg_write(struct iwl_mvm *mvm, char *buf,
1598                          size_t count, loff_t *ppos)
1599 {
1600         u8 args;
1601         u32 value;
1602
1603         args = sscanf(buf, "%i %i", &mvm->dbgfs_prph_reg_addr, &value);
1604         /* if we only want to set the reg address - nothing more to do */
1605         if (args == 1)
1606                 goto out;
1607
1608         /* otherwise, make sure we have both address and value */
1609         if (args != 2)
1610                 return -EINVAL;
1611
1612         iwl_write_prph(mvm->trans, mvm->dbgfs_prph_reg_addr, value);
1613
1614 out:
1615         return count;
1616 }
1617
1618 static ssize_t
1619 iwl_dbgfs_send_echo_cmd_write(struct iwl_mvm *mvm, char *buf,
1620                               size_t count, loff_t *ppos)
1621 {
1622         int ret;
1623
1624         if (!iwl_mvm_firmware_running(mvm))
1625                 return -EIO;
1626
1627         mutex_lock(&mvm->mutex);
1628         ret = iwl_mvm_send_cmd_pdu(mvm, ECHO_CMD, 0, 0, NULL);
1629         mutex_unlock(&mvm->mutex);
1630
1631         return ret ?: count;
1632 }
1633
1634 struct iwl_mvm_sniffer_apply {
1635         struct iwl_mvm *mvm;
1636         u8 *bssid;
1637         u16 aid;
1638 };
1639
1640 static bool iwl_mvm_sniffer_apply(struct iwl_notif_wait_data *notif_data,
1641                                   struct iwl_rx_packet *pkt, void *data)
1642 {
1643         struct iwl_mvm_sniffer_apply *apply = data;
1644
1645         apply->mvm->cur_aid = cpu_to_le16(apply->aid);
1646         memcpy(apply->mvm->cur_bssid, apply->bssid,
1647                sizeof(apply->mvm->cur_bssid));
1648
1649         return true;
1650 }
1651
1652 static ssize_t
1653 iwl_dbgfs_he_sniffer_params_write(struct iwl_mvm *mvm, char *buf,
1654                                   size_t count, loff_t *ppos)
1655 {
1656         struct iwl_notification_wait wait;
1657         struct iwl_he_monitor_cmd he_mon_cmd = {};
1658         struct iwl_mvm_sniffer_apply apply = {
1659                 .mvm = mvm,
1660         };
1661         u16 wait_cmds[] = {
1662                 iwl_cmd_id(HE_AIR_SNIFFER_CONFIG_CMD, DATA_PATH_GROUP, 0),
1663         };
1664         u32 aid;
1665         int ret;
1666
1667         if (!iwl_mvm_firmware_running(mvm))
1668                 return -EIO;
1669
1670         ret = sscanf(buf, "%x %2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx", &aid,
1671                      &he_mon_cmd.bssid[0], &he_mon_cmd.bssid[1],
1672                      &he_mon_cmd.bssid[2], &he_mon_cmd.bssid[3],
1673                      &he_mon_cmd.bssid[4], &he_mon_cmd.bssid[5]);
1674         if (ret != 7)
1675                 return -EINVAL;
1676
1677         he_mon_cmd.aid = cpu_to_le16(aid);
1678
1679         apply.aid = aid;
1680         apply.bssid = (void *)he_mon_cmd.bssid;
1681
1682         mutex_lock(&mvm->mutex);
1683
1684         /*
1685          * Use the notification waiter to get our function triggered
1686          * in sequence with other RX. This ensures that frames we get
1687          * on the RX queue _before_ the new configuration is applied
1688          * still have mvm->cur_aid pointing to the old AID, and that
1689          * frames on the RX queue _after_ the firmware processed the
1690          * new configuration (and sent the response, synchronously)
1691          * get mvm->cur_aid correctly set to the new AID.
1692          */
1693         iwl_init_notification_wait(&mvm->notif_wait, &wait,
1694                                    wait_cmds, ARRAY_SIZE(wait_cmds),
1695                                    iwl_mvm_sniffer_apply, &apply);
1696
1697         ret = iwl_mvm_send_cmd_pdu(mvm, iwl_cmd_id(HE_AIR_SNIFFER_CONFIG_CMD,
1698                                                    DATA_PATH_GROUP, 0), 0,
1699                                    sizeof(he_mon_cmd), &he_mon_cmd);
1700
1701         /* no need to really wait, we already did anyway */
1702         iwl_remove_notification(&mvm->notif_wait, &wait);
1703
1704         mutex_unlock(&mvm->mutex);
1705
1706         return ret ?: count;
1707 }
1708
1709 static ssize_t
1710 iwl_dbgfs_he_sniffer_params_read(struct file *file, char __user *user_buf,
1711                                  size_t count, loff_t *ppos)
1712 {
1713         struct iwl_mvm *mvm = file->private_data;
1714         u8 buf[32];
1715         int len;
1716
1717         len = scnprintf(buf, sizeof(buf),
1718                         "%d %02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx\n",
1719                         le16_to_cpu(mvm->cur_aid), mvm->cur_bssid[0],
1720                         mvm->cur_bssid[1], mvm->cur_bssid[2], mvm->cur_bssid[3],
1721                         mvm->cur_bssid[4], mvm->cur_bssid[5]);
1722
1723         return simple_read_from_buffer(user_buf, count, ppos, buf, len);
1724 }
1725
1726 static ssize_t
1727 iwl_dbgfs_uapsd_noagg_bssids_read(struct file *file, char __user *user_buf,
1728                                   size_t count, loff_t *ppos)
1729 {
1730         struct iwl_mvm *mvm = file->private_data;
1731         u8 buf[IWL_MVM_UAPSD_NOAGG_BSSIDS_NUM * ETH_ALEN * 3 + 1];
1732         unsigned int pos = 0;
1733         size_t bufsz = sizeof(buf);
1734         int i;
1735
1736         mutex_lock(&mvm->mutex);
1737
1738         for (i = 0; i < IWL_MVM_UAPSD_NOAGG_LIST_LEN; i++)
1739                 pos += scnprintf(buf + pos, bufsz - pos, "%pM\n",
1740                                  mvm->uapsd_noagg_bssids[i].addr);
1741
1742         mutex_unlock(&mvm->mutex);
1743
1744         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1745 }
1746
1747 static ssize_t
1748 iwl_dbgfs_ltr_config_write(struct iwl_mvm *mvm,
1749                            char *buf, size_t count, loff_t *ppos)
1750 {
1751         int ret;
1752         struct iwl_ltr_config_cmd ltr_config = {0};
1753
1754         if (!iwl_mvm_firmware_running(mvm))
1755                 return -EIO;
1756
1757         if (sscanf(buf, "%x,%x,%x,%x,%x,%x,%x",
1758                    &ltr_config.flags,
1759                    &ltr_config.static_long,
1760                    &ltr_config.static_short,
1761                    &ltr_config.ltr_cfg_values[0],
1762                    &ltr_config.ltr_cfg_values[1],
1763                    &ltr_config.ltr_cfg_values[2],
1764                    &ltr_config.ltr_cfg_values[3]) != 7) {
1765                 return -EINVAL;
1766         }
1767
1768         mutex_lock(&mvm->mutex);
1769         ret = iwl_mvm_send_cmd_pdu(mvm, LTR_CONFIG, 0, sizeof(ltr_config),
1770                                    &ltr_config);
1771         mutex_unlock(&mvm->mutex);
1772
1773         if (ret)
1774                 IWL_ERR(mvm, "failed to send ltr configuration cmd\n");
1775
1776         return ret ?: count;
1777 }
1778
1779 static ssize_t iwl_dbgfs_rfi_freq_table_write(struct iwl_mvm *mvm, char *buf,
1780                                               size_t count, loff_t *ppos)
1781 {
1782         int ret = 0;
1783         u16 op_id;
1784
1785         if (kstrtou16(buf, 10, &op_id))
1786                 return -EINVAL;
1787
1788         /* value zero triggers re-sending the default table to the device */
1789         if (!op_id) {
1790                 mutex_lock(&mvm->mutex);
1791                 ret = iwl_rfi_send_config_cmd(mvm, NULL);
1792                 mutex_unlock(&mvm->mutex);
1793         } else {
1794                 ret = -EOPNOTSUPP; /* in the future a new table will be added */
1795         }
1796
1797         return ret ?: count;
1798 }
1799
1800 /* The size computation is as follows:
1801  * each number needs at most 3 characters, number of rows is the size of
1802  * the table; So, need 5 chars for the "freq: " part and each tuple afterwards
1803  * needs 6 characters for numbers and 5 for the punctuation around.
1804  */
1805 #define IWL_RFI_BUF_SIZE (IWL_RFI_LUT_INSTALLED_SIZE *\
1806                                 (5 + IWL_RFI_LUT_ENTRY_CHANNELS_NUM * (6 + 5)))
1807
1808 static ssize_t iwl_dbgfs_rfi_freq_table_read(struct file *file,
1809                                              char __user *user_buf,
1810                                              size_t count, loff_t *ppos)
1811 {
1812         struct iwl_mvm *mvm = file->private_data;
1813         struct iwl_rfi_freq_table_resp_cmd *resp;
1814         u32 status;
1815         char buf[IWL_RFI_BUF_SIZE];
1816         int i, j, pos = 0;
1817
1818         resp = iwl_rfi_get_freq_table(mvm);
1819         if (IS_ERR(resp))
1820                 return PTR_ERR(resp);
1821
1822         status = le32_to_cpu(resp->status);
1823         if (status != RFI_FREQ_TABLE_OK) {
1824                 scnprintf(buf, IWL_RFI_BUF_SIZE, "status = %d\n", status);
1825                 goto out;
1826         }
1827
1828         for (i = 0; i < ARRAY_SIZE(resp->table); i++) {
1829                 pos += scnprintf(buf + pos, IWL_RFI_BUF_SIZE - pos, "%d: ",
1830                                  resp->table[i].freq);
1831
1832                 for (j = 0; j < ARRAY_SIZE(resp->table[i].channels); j++)
1833                         pos += scnprintf(buf + pos, IWL_RFI_BUF_SIZE - pos,
1834                                          "(%d, %d) ",
1835                                          resp->table[i].channels[j],
1836                                          resp->table[i].bands[j]);
1837                 pos += scnprintf(buf + pos, IWL_RFI_BUF_SIZE - pos, "\n");
1838         }
1839
1840 out:
1841         kfree(resp);
1842         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1843 }
1844
1845 MVM_DEBUGFS_READ_WRITE_FILE_OPS(prph_reg, 64);
1846
1847 /* Device wide debugfs entries */
1848 MVM_DEBUGFS_READ_FILE_OPS(ctdp_budget);
1849 MVM_DEBUGFS_WRITE_FILE_OPS(stop_ctdp, 8);
1850 MVM_DEBUGFS_WRITE_FILE_OPS(force_ctkill, 8);
1851 MVM_DEBUGFS_WRITE_FILE_OPS(tx_flush, 16);
1852 MVM_DEBUGFS_WRITE_FILE_OPS(sta_drain, 8);
1853 MVM_DEBUGFS_WRITE_FILE_OPS(send_echo_cmd, 8);
1854 MVM_DEBUGFS_READ_WRITE_FILE_OPS(sram, 64);
1855 MVM_DEBUGFS_READ_WRITE_FILE_OPS(set_nic_temperature, 64);
1856 MVM_DEBUGFS_READ_FILE_OPS(nic_temp);
1857 MVM_DEBUGFS_READ_FILE_OPS(stations);
1858 MVM_DEBUGFS_READ_FILE_OPS(rs_data);
1859 MVM_DEBUGFS_READ_FILE_OPS(bt_notif);
1860 MVM_DEBUGFS_READ_FILE_OPS(bt_cmd);
1861 MVM_DEBUGFS_READ_WRITE_FILE_OPS(disable_power_off, 64);
1862 MVM_DEBUGFS_READ_FILE_OPS(fw_rx_stats);
1863 MVM_DEBUGFS_READ_FILE_OPS(drv_rx_stats);
1864 MVM_DEBUGFS_READ_FILE_OPS(fw_ver);
1865 MVM_DEBUGFS_READ_FILE_OPS(phy_integration_ver);
1866 MVM_DEBUGFS_WRITE_FILE_OPS(fw_restart, 10);
1867 MVM_DEBUGFS_WRITE_FILE_OPS(fw_nmi, 10);
1868 MVM_DEBUGFS_WRITE_FILE_OPS(bt_tx_prio, 10);
1869 MVM_DEBUGFS_WRITE_FILE_OPS(bt_force_ant, 10);
1870 MVM_DEBUGFS_READ_WRITE_FILE_OPS(scan_ant_rxchain, 8);
1871 MVM_DEBUGFS_READ_WRITE_FILE_OPS(fw_dbg_conf, 8);
1872 MVM_DEBUGFS_WRITE_FILE_OPS(fw_dbg_collect, 64);
1873 MVM_DEBUGFS_WRITE_FILE_OPS(dbg_time_point, 64);
1874 MVM_DEBUGFS_WRITE_FILE_OPS(indirection_tbl,
1875                            (IWL_RSS_INDIRECTION_TABLE_SIZE * 2));
1876 MVM_DEBUGFS_WRITE_FILE_OPS(inject_packet, 512);
1877 MVM_DEBUGFS_WRITE_FILE_OPS(inject_beacon_ie, 512);
1878 MVM_DEBUGFS_WRITE_FILE_OPS(inject_beacon_ie_restore, 512);
1879
1880 MVM_DEBUGFS_READ_FILE_OPS(uapsd_noagg_bssids);
1881
1882 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1883 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters, 256);
1884 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters_macs, 256);
1885 #endif
1886
1887 #ifdef CONFIG_ACPI
1888 MVM_DEBUGFS_READ_FILE_OPS(sar_geo_profile);
1889 #endif
1890
1891 MVM_DEBUGFS_READ_WRITE_STA_FILE_OPS(amsdu_len, 16);
1892
1893 MVM_DEBUGFS_READ_WRITE_FILE_OPS(he_sniffer_params, 32);
1894
1895 MVM_DEBUGFS_WRITE_FILE_OPS(ltr_config, 512);
1896 MVM_DEBUGFS_READ_WRITE_FILE_OPS(rfi_freq_table, 16);
1897
1898 static ssize_t iwl_dbgfs_mem_read(struct file *file, char __user *user_buf,
1899                                   size_t count, loff_t *ppos)
1900 {
1901         struct iwl_mvm *mvm = file->private_data;
1902         struct iwl_dbg_mem_access_cmd cmd = {};
1903         struct iwl_dbg_mem_access_rsp *rsp;
1904         struct iwl_host_cmd hcmd = {
1905                 .flags = CMD_WANT_SKB | CMD_SEND_IN_RFKILL,
1906                 .data = { &cmd, },
1907                 .len = { sizeof(cmd) },
1908         };
1909         size_t delta;
1910         ssize_t ret, len;
1911
1912         if (!iwl_mvm_firmware_running(mvm))
1913                 return -EIO;
1914
1915         hcmd.id = iwl_cmd_id(*ppos >> 24 ? UMAC_RD_WR : LMAC_RD_WR,
1916                              DEBUG_GROUP, 0);
1917         cmd.op = cpu_to_le32(DEBUG_MEM_OP_READ);
1918
1919         /* Take care of alignment of both the position and the length */
1920         delta = *ppos & 0x3;
1921         cmd.addr = cpu_to_le32(*ppos - delta);
1922         cmd.len = cpu_to_le32(min(ALIGN(count + delta, 4) / 4,
1923                                   (size_t)DEBUG_MEM_MAX_SIZE_DWORDS));
1924
1925         mutex_lock(&mvm->mutex);
1926         ret = iwl_mvm_send_cmd(mvm, &hcmd);
1927         mutex_unlock(&mvm->mutex);
1928
1929         if (ret < 0)
1930                 return ret;
1931
1932         rsp = (void *)hcmd.resp_pkt->data;
1933         if (le32_to_cpu(rsp->status) != DEBUG_MEM_STATUS_SUCCESS) {
1934                 ret = -ENXIO;
1935                 goto out;
1936         }
1937
1938         len = min((size_t)le32_to_cpu(rsp->len) << 2,
1939                   iwl_rx_packet_payload_len(hcmd.resp_pkt) - sizeof(*rsp));
1940         len = min(len - delta, count);
1941         if (len < 0) {
1942                 ret = -EFAULT;
1943                 goto out;
1944         }
1945
1946         ret = len - copy_to_user(user_buf, (void *)rsp->data + delta, len);
1947         *ppos += ret;
1948
1949 out:
1950         iwl_free_resp(&hcmd);
1951         return ret;
1952 }
1953
1954 static ssize_t iwl_dbgfs_mem_write(struct file *file,
1955                                    const char __user *user_buf, size_t count,
1956                                    loff_t *ppos)
1957 {
1958         struct iwl_mvm *mvm = file->private_data;
1959         struct iwl_dbg_mem_access_cmd *cmd;
1960         struct iwl_dbg_mem_access_rsp *rsp;
1961         struct iwl_host_cmd hcmd = {};
1962         size_t cmd_size;
1963         size_t data_size;
1964         u32 op, len;
1965         ssize_t ret;
1966
1967         if (!iwl_mvm_firmware_running(mvm))
1968                 return -EIO;
1969
1970         hcmd.id = iwl_cmd_id(*ppos >> 24 ? UMAC_RD_WR : LMAC_RD_WR,
1971                              DEBUG_GROUP, 0);
1972
1973         if (*ppos & 0x3 || count < 4) {
1974                 op = DEBUG_MEM_OP_WRITE_BYTES;
1975                 len = min(count, (size_t)(4 - (*ppos & 0x3)));
1976                 data_size = len;
1977         } else {
1978                 op = DEBUG_MEM_OP_WRITE;
1979                 len = min(count >> 2, (size_t)DEBUG_MEM_MAX_SIZE_DWORDS);
1980                 data_size = len << 2;
1981         }
1982
1983         cmd_size = sizeof(*cmd) + ALIGN(data_size, 4);
1984         cmd = kzalloc(cmd_size, GFP_KERNEL);
1985         if (!cmd)
1986                 return -ENOMEM;
1987
1988         cmd->op = cpu_to_le32(op);
1989         cmd->len = cpu_to_le32(len);
1990         cmd->addr = cpu_to_le32(*ppos);
1991         if (copy_from_user((void *)cmd->data, user_buf, data_size)) {
1992                 kfree(cmd);
1993                 return -EFAULT;
1994         }
1995
1996         hcmd.flags = CMD_WANT_SKB | CMD_SEND_IN_RFKILL,
1997         hcmd.data[0] = (void *)cmd;
1998         hcmd.len[0] = cmd_size;
1999
2000         mutex_lock(&mvm->mutex);
2001         ret = iwl_mvm_send_cmd(mvm, &hcmd);
2002         mutex_unlock(&mvm->mutex);
2003
2004         kfree(cmd);
2005
2006         if (ret < 0)
2007                 return ret;
2008
2009         rsp = (void *)hcmd.resp_pkt->data;
2010         if (rsp->status != DEBUG_MEM_STATUS_SUCCESS) {
2011                 ret = -ENXIO;
2012                 goto out;
2013         }
2014
2015         ret = data_size;
2016         *ppos += ret;
2017
2018 out:
2019         iwl_free_resp(&hcmd);
2020         return ret;
2021 }
2022
2023 static const struct file_operations iwl_dbgfs_mem_ops = {
2024         .read = iwl_dbgfs_mem_read,
2025         .write = iwl_dbgfs_mem_write,
2026         .open = simple_open,
2027         .llseek = default_llseek,
2028 };
2029
2030 void iwl_mvm_sta_add_debugfs(struct ieee80211_hw *hw,
2031                              struct ieee80211_vif *vif,
2032                              struct ieee80211_sta *sta,
2033                              struct dentry *dir)
2034 {
2035         struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2036
2037         if (iwl_mvm_has_tlc_offload(mvm)) {
2038                 MVM_DEBUGFS_ADD_STA_FILE(rs_data, dir, 0400);
2039         }
2040         MVM_DEBUGFS_ADD_STA_FILE(amsdu_len, dir, 0600);
2041 }
2042
2043 void iwl_mvm_dbgfs_register(struct iwl_mvm *mvm)
2044 {
2045         struct dentry *bcast_dir __maybe_unused;
2046         char buf[100];
2047
2048         spin_lock_init(&mvm->drv_stats_lock);
2049
2050         MVM_DEBUGFS_ADD_FILE(tx_flush, mvm->debugfs_dir, 0200);
2051         MVM_DEBUGFS_ADD_FILE(sta_drain, mvm->debugfs_dir, 0200);
2052         MVM_DEBUGFS_ADD_FILE(sram, mvm->debugfs_dir, 0600);
2053         MVM_DEBUGFS_ADD_FILE(set_nic_temperature, mvm->debugfs_dir, 0600);
2054         MVM_DEBUGFS_ADD_FILE(nic_temp, mvm->debugfs_dir, 0400);
2055         MVM_DEBUGFS_ADD_FILE(ctdp_budget, mvm->debugfs_dir, 0400);
2056         MVM_DEBUGFS_ADD_FILE(stop_ctdp, mvm->debugfs_dir, 0200);
2057         MVM_DEBUGFS_ADD_FILE(force_ctkill, mvm->debugfs_dir, 0200);
2058         MVM_DEBUGFS_ADD_FILE(stations, mvm->debugfs_dir, 0400);
2059         MVM_DEBUGFS_ADD_FILE(bt_notif, mvm->debugfs_dir, 0400);
2060         MVM_DEBUGFS_ADD_FILE(bt_cmd, mvm->debugfs_dir, 0400);
2061         MVM_DEBUGFS_ADD_FILE(disable_power_off, mvm->debugfs_dir, 0600);
2062         MVM_DEBUGFS_ADD_FILE(fw_ver, mvm->debugfs_dir, 0400);
2063         MVM_DEBUGFS_ADD_FILE(fw_rx_stats, mvm->debugfs_dir, 0400);
2064         MVM_DEBUGFS_ADD_FILE(drv_rx_stats, mvm->debugfs_dir, 0400);
2065         MVM_DEBUGFS_ADD_FILE(fw_restart, mvm->debugfs_dir, 0200);
2066         MVM_DEBUGFS_ADD_FILE(fw_nmi, mvm->debugfs_dir, 0200);
2067         MVM_DEBUGFS_ADD_FILE(bt_tx_prio, mvm->debugfs_dir, 0200);
2068         MVM_DEBUGFS_ADD_FILE(bt_force_ant, mvm->debugfs_dir, 0200);
2069         MVM_DEBUGFS_ADD_FILE(scan_ant_rxchain, mvm->debugfs_dir, 0600);
2070         MVM_DEBUGFS_ADD_FILE(prph_reg, mvm->debugfs_dir, 0600);
2071         MVM_DEBUGFS_ADD_FILE(fw_dbg_conf, mvm->debugfs_dir, 0600);
2072         MVM_DEBUGFS_ADD_FILE(fw_dbg_collect, mvm->debugfs_dir, 0200);
2073         MVM_DEBUGFS_ADD_FILE(send_echo_cmd, mvm->debugfs_dir, 0200);
2074         MVM_DEBUGFS_ADD_FILE(indirection_tbl, mvm->debugfs_dir, 0200);
2075         MVM_DEBUGFS_ADD_FILE(inject_packet, mvm->debugfs_dir, 0200);
2076         MVM_DEBUGFS_ADD_FILE(inject_beacon_ie, mvm->debugfs_dir, 0200);
2077         MVM_DEBUGFS_ADD_FILE(inject_beacon_ie_restore, mvm->debugfs_dir, 0200);
2078         MVM_DEBUGFS_ADD_FILE(rfi_freq_table, mvm->debugfs_dir, 0600);
2079
2080         if (mvm->fw->phy_integration_ver)
2081                 MVM_DEBUGFS_ADD_FILE(phy_integration_ver, mvm->debugfs_dir, 0400);
2082 #ifdef CONFIG_ACPI
2083         MVM_DEBUGFS_ADD_FILE(sar_geo_profile, mvm->debugfs_dir, 0400);
2084 #endif
2085         MVM_DEBUGFS_ADD_FILE(he_sniffer_params, mvm->debugfs_dir, 0600);
2086
2087         if (fw_has_capa(&mvm->fw->ucode_capa, IWL_UCODE_TLV_CAPA_SET_LTR_GEN2))
2088                 MVM_DEBUGFS_ADD_FILE(ltr_config, mvm->debugfs_dir, 0200);
2089
2090         debugfs_create_bool("enable_scan_iteration_notif", 0600,
2091                             mvm->debugfs_dir, &mvm->scan_iter_notif_enabled);
2092         debugfs_create_bool("drop_bcn_ap_mode", 0600, mvm->debugfs_dir,
2093                             &mvm->drop_bcn_ap_mode);
2094
2095         MVM_DEBUGFS_ADD_FILE(uapsd_noagg_bssids, mvm->debugfs_dir, S_IRUSR);
2096
2097 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
2098         if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING) {
2099                 bcast_dir = debugfs_create_dir("bcast_filtering",
2100                                                mvm->debugfs_dir);
2101
2102                 debugfs_create_bool("override", 0600, bcast_dir,
2103                                     &mvm->dbgfs_bcast_filtering.override);
2104
2105                 MVM_DEBUGFS_ADD_FILE_ALIAS("filters", bcast_filters,
2106                                            bcast_dir, 0600);
2107                 MVM_DEBUGFS_ADD_FILE_ALIAS("macs", bcast_filters_macs,
2108                                            bcast_dir, 0600);
2109         }
2110 #endif
2111
2112 #ifdef CONFIG_PM_SLEEP
2113         MVM_DEBUGFS_ADD_FILE(d3_test, mvm->debugfs_dir, 0400);
2114         debugfs_create_bool("d3_wake_sysassert", 0600, mvm->debugfs_dir,
2115                             &mvm->d3_wake_sysassert);
2116         debugfs_create_u32("last_netdetect_scans", 0400, mvm->debugfs_dir,
2117                            &mvm->last_netdetect_scans);
2118 #endif
2119
2120         debugfs_create_u8("ps_disabled", 0400, mvm->debugfs_dir,
2121                           &mvm->ps_disabled);
2122         debugfs_create_blob("nvm_hw", 0400, mvm->debugfs_dir,
2123                             &mvm->nvm_hw_blob);
2124         debugfs_create_blob("nvm_sw", 0400, mvm->debugfs_dir,
2125                             &mvm->nvm_sw_blob);
2126         debugfs_create_blob("nvm_calib", 0400, mvm->debugfs_dir,
2127                             &mvm->nvm_calib_blob);
2128         debugfs_create_blob("nvm_prod", 0400, mvm->debugfs_dir,
2129                             &mvm->nvm_prod_blob);
2130         debugfs_create_blob("nvm_phy_sku", 0400, mvm->debugfs_dir,
2131                             &mvm->nvm_phy_sku_blob);
2132         debugfs_create_blob("nvm_reg", S_IRUSR,
2133                             mvm->debugfs_dir, &mvm->nvm_reg_blob);
2134
2135         debugfs_create_file("mem", 0600, mvm->debugfs_dir, mvm,
2136                             &iwl_dbgfs_mem_ops);
2137
2138         /*
2139          * Create a symlink with mac80211. It will be removed when mac80211
2140          * exists (before the opmode exists which removes the target.)
2141          */
2142         snprintf(buf, 100, "../../%pd2", mvm->debugfs_dir->d_parent);
2143         debugfs_create_symlink("iwlwifi", mvm->hw->wiphy->debugfsdir, buf);
2144 }