1fba6b421d31106b49fe0d453d85fe6bc4dce3b9
[linux-2.6-block.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
309         if (!iwl_mvm_firmware_running(mvm))
310                 return -EIO;
311
312         mutex_lock(&mvm->mutex);
313         tbl_idx = iwl_mvm_get_sar_geo_profile(mvm);
314         if (tbl_idx < 0) {
315                 mutex_unlock(&mvm->mutex);
316                 return tbl_idx;
317         }
318
319         if (!tbl_idx) {
320                 pos = scnprintf(buf, bufsz,
321                                 "SAR geographic profile disabled\n");
322         } else {
323                 pos += scnprintf(buf + pos, bufsz - pos,
324                                  "Use geographic profile %d\n", tbl_idx);
325                 pos += scnprintf(buf + pos, bufsz - pos,
326                                  "2.4GHz:\n\tChain A offset: %hhu dBm\n\tChain B offset: %hhu dBm\n\tmax tx power: %hhu dBm\n",
327                                  mvm->fwrt.geo_profiles[tbl_idx - 1].bands[0].chains[0],
328                                  mvm->fwrt.geo_profiles[tbl_idx - 1].bands[0].chains[1],
329                                  mvm->fwrt.geo_profiles[tbl_idx - 1].bands[0].max);
330                 pos += scnprintf(buf + pos, bufsz - pos,
331                                  "5.2GHz:\n\tChain A offset: %hhu dBm\n\tChain B offset: %hhu dBm\n\tmax tx power: %hhu dBm\n",
332                                  mvm->fwrt.geo_profiles[tbl_idx - 1].bands[1].chains[0],
333                                  mvm->fwrt.geo_profiles[tbl_idx - 1].bands[1].chains[1],
334                                  mvm->fwrt.geo_profiles[tbl_idx - 1].bands[1].max);
335         }
336         mutex_unlock(&mvm->mutex);
337
338         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
339 }
340 #endif
341
342 static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf,
343                                        size_t count, loff_t *ppos)
344 {
345         struct iwl_mvm *mvm = file->private_data;
346         struct ieee80211_sta *sta;
347         char buf[400];
348         int i, pos = 0, bufsz = sizeof(buf);
349
350         mutex_lock(&mvm->mutex);
351
352         for (i = 0; i < mvm->fw->ucode_capa.num_stations; i++) {
353                 pos += scnprintf(buf + pos, bufsz - pos, "%.2d: ", i);
354                 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[i],
355                                                 lockdep_is_held(&mvm->mutex));
356                 if (!sta)
357                         pos += scnprintf(buf + pos, bufsz - pos, "N/A\n");
358                 else if (IS_ERR(sta))
359                         pos += scnprintf(buf + pos, bufsz - pos, "%ld\n",
360                                          PTR_ERR(sta));
361                 else
362                         pos += scnprintf(buf + pos, bufsz - pos, "%pM\n",
363                                          sta->addr);
364         }
365
366         mutex_unlock(&mvm->mutex);
367
368         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
369 }
370
371 static ssize_t iwl_dbgfs_rs_data_read(struct file *file, char __user *user_buf,
372                                       size_t count, loff_t *ppos)
373 {
374         struct ieee80211_sta *sta = file->private_data;
375         struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
376         struct iwl_lq_sta_rs_fw *lq_sta = &mvmsta->lq_sta.rs_fw;
377         struct iwl_mvm *mvm = lq_sta->pers.drv;
378         static const size_t bufsz = 2048;
379         char *buff;
380         int desc = 0;
381         ssize_t ret;
382
383         buff = kmalloc(bufsz, GFP_KERNEL);
384         if (!buff)
385                 return -ENOMEM;
386
387         mutex_lock(&mvm->mutex);
388
389         desc += scnprintf(buff + desc, bufsz - desc, "sta_id %d\n",
390                           lq_sta->pers.sta_id);
391         desc += scnprintf(buff + desc, bufsz - desc,
392                           "fixed rate 0x%X\n",
393                           lq_sta->pers.dbg_fixed_rate);
394         desc += scnprintf(buff + desc, bufsz - desc,
395                           "A-MPDU size limit %d\n",
396                           lq_sta->pers.dbg_agg_frame_count_lim);
397         desc += scnprintf(buff + desc, bufsz - desc,
398                           "valid_tx_ant %s%s\n",
399                 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_A) ? "ANT_A," : "",
400                 (iwl_mvm_get_valid_tx_ant(mvm) & ANT_B) ? "ANT_B," : "");
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_v1(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         pos += scnprintf(buf + pos, bufsz - pos, " (%hhx)\n", mvm->scan_rx_ant);
1063
1064         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1065 }
1066
1067 static ssize_t
1068 iwl_dbgfs_scan_ant_rxchain_write(struct iwl_mvm *mvm, char *buf,
1069                                  size_t count, loff_t *ppos)
1070 {
1071         u8 scan_rx_ant;
1072
1073         if (!iwl_mvm_firmware_running(mvm))
1074                 return -EIO;
1075
1076         if (sscanf(buf, "%hhx", &scan_rx_ant) != 1)
1077                 return -EINVAL;
1078         if (scan_rx_ant > ANT_ABC)
1079                 return -EINVAL;
1080         if (scan_rx_ant & ~(iwl_mvm_get_valid_rx_ant(mvm)))
1081                 return -EINVAL;
1082
1083         if (mvm->scan_rx_ant != scan_rx_ant) {
1084                 mvm->scan_rx_ant = scan_rx_ant;
1085                 if (fw_has_capa(&mvm->fw->ucode_capa,
1086                                 IWL_UCODE_TLV_CAPA_UMAC_SCAN))
1087                         iwl_mvm_config_scan(mvm);
1088         }
1089
1090         return count;
1091 }
1092
1093 static ssize_t iwl_dbgfs_indirection_tbl_write(struct iwl_mvm *mvm,
1094                                                char *buf, size_t count,
1095                                                loff_t *ppos)
1096 {
1097         struct iwl_rss_config_cmd cmd = {
1098                 .flags = cpu_to_le32(IWL_RSS_ENABLE),
1099                 .hash_mask = IWL_RSS_HASH_TYPE_IPV4_TCP |
1100                              IWL_RSS_HASH_TYPE_IPV4_UDP |
1101                              IWL_RSS_HASH_TYPE_IPV4_PAYLOAD |
1102                              IWL_RSS_HASH_TYPE_IPV6_TCP |
1103                              IWL_RSS_HASH_TYPE_IPV6_UDP |
1104                              IWL_RSS_HASH_TYPE_IPV6_PAYLOAD,
1105         };
1106         int ret, i, num_repeats, nbytes = count / 2;
1107
1108         ret = hex2bin(cmd.indirection_table, buf, nbytes);
1109         if (ret)
1110                 return ret;
1111
1112         /*
1113          * The input is the redirection table, partial or full.
1114          * Repeat the pattern if needed.
1115          * For example, input of 01020F will be repeated 42 times,
1116          * indirecting RSS hash results to queues 1, 2, 15 (skipping
1117          * queues 3 - 14).
1118          */
1119         num_repeats = ARRAY_SIZE(cmd.indirection_table) / nbytes;
1120         for (i = 1; i < num_repeats; i++)
1121                 memcpy(&cmd.indirection_table[i * nbytes],
1122                        cmd.indirection_table, nbytes);
1123         /* handle cut in the middle pattern for the last places */
1124         memcpy(&cmd.indirection_table[i * nbytes], cmd.indirection_table,
1125                ARRAY_SIZE(cmd.indirection_table) % nbytes);
1126
1127         netdev_rss_key_fill(cmd.secret_key, sizeof(cmd.secret_key));
1128
1129         mutex_lock(&mvm->mutex);
1130         if (iwl_mvm_firmware_running(mvm))
1131                 ret = iwl_mvm_send_cmd_pdu(mvm, RSS_CONFIG_CMD, 0,
1132                                            sizeof(cmd), &cmd);
1133         else
1134                 ret = 0;
1135         mutex_unlock(&mvm->mutex);
1136
1137         return ret ?: count;
1138 }
1139
1140 static ssize_t iwl_dbgfs_inject_packet_write(struct iwl_mvm *mvm,
1141                                              char *buf, size_t count,
1142                                              loff_t *ppos)
1143 {
1144         struct iwl_op_mode *opmode = container_of((void *)mvm,
1145                                                   struct iwl_op_mode,
1146                                                   op_mode_specific);
1147         struct iwl_rx_cmd_buffer rxb = {
1148                 ._rx_page_order = 0,
1149                 .truesize = 0, /* not used */
1150                 ._offset = 0,
1151         };
1152         struct iwl_rx_packet *pkt;
1153         int bin_len = count / 2;
1154         int ret = -EINVAL;
1155
1156         if (!iwl_mvm_firmware_running(mvm))
1157                 return -EIO;
1158
1159         /* supporting only MQ RX */
1160         if (!mvm->trans->trans_cfg->mq_rx_supported)
1161                 return -ENOTSUPP;
1162
1163         rxb._page = alloc_pages(GFP_ATOMIC, 0);
1164         if (!rxb._page)
1165                 return -ENOMEM;
1166         pkt = rxb_addr(&rxb);
1167
1168         ret = hex2bin(page_address(rxb._page), buf, bin_len);
1169         if (ret)
1170                 goto out;
1171
1172         /* avoid invalid memory access and malformed packet */
1173         if (bin_len < sizeof(*pkt) ||
1174             bin_len != sizeof(*pkt) + iwl_rx_packet_payload_len(pkt))
1175                 goto out;
1176
1177         local_bh_disable();
1178         iwl_mvm_rx_mq(opmode, NULL, &rxb);
1179         local_bh_enable();
1180         ret = 0;
1181
1182 out:
1183         iwl_free_rxb(&rxb);
1184
1185         return ret ?: count;
1186 }
1187
1188 static int _iwl_dbgfs_inject_beacon_ie(struct iwl_mvm *mvm, char *bin, int len)
1189 {
1190         struct ieee80211_vif *vif;
1191         struct iwl_mvm_vif *mvmvif;
1192         struct sk_buff *beacon;
1193         struct ieee80211_tx_info *info;
1194         struct iwl_mac_beacon_cmd beacon_cmd = {};
1195         u8 rate;
1196         u16 flags;
1197         int i;
1198
1199         len /= 2;
1200
1201         /* Element len should be represented by u8 */
1202         if (len >= U8_MAX)
1203                 return -EINVAL;
1204
1205         if (!iwl_mvm_firmware_running(mvm))
1206                 return -EIO;
1207
1208         if (!iwl_mvm_has_new_tx_api(mvm) &&
1209             !fw_has_api(&mvm->fw->ucode_capa,
1210                         IWL_UCODE_TLV_API_NEW_BEACON_TEMPLATE))
1211                 return -EINVAL;
1212
1213         mutex_lock(&mvm->mutex);
1214
1215         for (i = 0; i < NUM_MAC_INDEX_DRIVER; i++) {
1216                 vif = iwl_mvm_rcu_dereference_vif_id(mvm, i, false);
1217                 if (!vif)
1218                         continue;
1219
1220                 if (vif->type == NL80211_IFTYPE_AP)
1221                         break;
1222         }
1223
1224         if (i == NUM_MAC_INDEX_DRIVER || !vif)
1225                 goto out_err;
1226
1227         mvm->hw->extra_beacon_tailroom = len;
1228
1229         beacon = ieee80211_beacon_get_template(mvm->hw, vif, NULL);
1230         if (!beacon)
1231                 goto out_err;
1232
1233         if (len && hex2bin(skb_put_zero(beacon, len), bin, len)) {
1234                 dev_kfree_skb(beacon);
1235                 goto out_err;
1236         }
1237
1238         mvm->beacon_inject_active = true;
1239
1240         mvmvif = iwl_mvm_vif_from_mac80211(vif);
1241         info = IEEE80211_SKB_CB(beacon);
1242         rate = iwl_mvm_mac_ctxt_get_lowest_rate(info, vif);
1243         flags = iwl_mvm_mac80211_idx_to_hwrate(rate);
1244
1245         if (rate == IWL_FIRST_CCK_RATE)
1246                 flags |= IWL_MAC_BEACON_CCK;
1247
1248         beacon_cmd.flags = cpu_to_le16(flags);
1249         beacon_cmd.byte_cnt = cpu_to_le16((u16)beacon->len);
1250         beacon_cmd.template_id = cpu_to_le32((u32)mvmvif->id);
1251
1252         iwl_mvm_mac_ctxt_set_tim(mvm, &beacon_cmd.tim_idx,
1253                                  &beacon_cmd.tim_size,
1254                                  beacon->data, beacon->len);
1255
1256         iwl_mvm_mac_ctxt_send_beacon_cmd(mvm, beacon, &beacon_cmd,
1257                                          sizeof(beacon_cmd));
1258         mutex_unlock(&mvm->mutex);
1259
1260         dev_kfree_skb(beacon);
1261
1262         return 0;
1263
1264 out_err:
1265         mutex_unlock(&mvm->mutex);
1266         return -EINVAL;
1267 }
1268
1269 static ssize_t iwl_dbgfs_inject_beacon_ie_write(struct iwl_mvm *mvm,
1270                                                 char *buf, size_t count,
1271                                                 loff_t *ppos)
1272 {
1273         int ret = _iwl_dbgfs_inject_beacon_ie(mvm, buf, count);
1274
1275         mvm->hw->extra_beacon_tailroom = 0;
1276         return ret ?: count;
1277 }
1278
1279 static ssize_t iwl_dbgfs_inject_beacon_ie_restore_write(struct iwl_mvm *mvm,
1280                                                         char *buf,
1281                                                         size_t count,
1282                                                         loff_t *ppos)
1283 {
1284         int ret = _iwl_dbgfs_inject_beacon_ie(mvm, NULL, 0);
1285
1286         mvm->hw->extra_beacon_tailroom = 0;
1287         mvm->beacon_inject_active = false;
1288         return ret ?: count;
1289 }
1290
1291 static ssize_t iwl_dbgfs_fw_dbg_conf_read(struct file *file,
1292                                           char __user *user_buf,
1293                                           size_t count, loff_t *ppos)
1294 {
1295         struct iwl_mvm *mvm = file->private_data;
1296         int conf;
1297         char buf[8];
1298         const size_t bufsz = sizeof(buf);
1299         int pos = 0;
1300
1301         mutex_lock(&mvm->mutex);
1302         conf = mvm->fwrt.dump.conf;
1303         mutex_unlock(&mvm->mutex);
1304
1305         pos += scnprintf(buf + pos, bufsz - pos, "%d\n", conf);
1306
1307         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1308 }
1309
1310 static ssize_t iwl_dbgfs_fw_dbg_conf_write(struct iwl_mvm *mvm,
1311                                            char *buf, size_t count,
1312                                            loff_t *ppos)
1313 {
1314         unsigned int conf_id;
1315         int ret;
1316
1317         if (!iwl_mvm_firmware_running(mvm))
1318                 return -EIO;
1319
1320         ret = kstrtouint(buf, 0, &conf_id);
1321         if (ret)
1322                 return ret;
1323
1324         if (WARN_ON(conf_id >= FW_DBG_CONF_MAX))
1325                 return -EINVAL;
1326
1327         mutex_lock(&mvm->mutex);
1328         ret = iwl_fw_start_dbg_conf(&mvm->fwrt, conf_id);
1329         mutex_unlock(&mvm->mutex);
1330
1331         return ret ?: count;
1332 }
1333
1334 static ssize_t iwl_dbgfs_fw_dbg_collect_write(struct iwl_mvm *mvm,
1335                                               char *buf, size_t count,
1336                                               loff_t *ppos)
1337 {
1338         if (count == 0)
1339                 return 0;
1340
1341         iwl_dbg_tlv_time_point(&mvm->fwrt, IWL_FW_INI_TIME_POINT_USER_TRIGGER,
1342                                NULL);
1343
1344         iwl_fw_dbg_collect(&mvm->fwrt, FW_DBG_TRIGGER_USER, buf,
1345                            (count - 1), NULL);
1346
1347         return count;
1348 }
1349
1350 static ssize_t iwl_dbgfs_dbg_time_point_write(struct iwl_mvm *mvm,
1351                                               char *buf, size_t count,
1352                                               loff_t *ppos)
1353 {
1354         u32 timepoint;
1355
1356         if (kstrtou32(buf, 0, &timepoint))
1357                 return -EINVAL;
1358
1359         if (timepoint == IWL_FW_INI_TIME_POINT_INVALID ||
1360             timepoint >= IWL_FW_INI_TIME_POINT_NUM)
1361                 return -EINVAL;
1362
1363         iwl_dbg_tlv_time_point(&mvm->fwrt, timepoint, NULL);
1364
1365         return count;
1366 }
1367
1368 #define ADD_TEXT(...) pos += scnprintf(buf + pos, bufsz - pos, __VA_ARGS__)
1369 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1370 static ssize_t iwl_dbgfs_bcast_filters_read(struct file *file,
1371                                             char __user *user_buf,
1372                                             size_t count, loff_t *ppos)
1373 {
1374         struct iwl_mvm *mvm = file->private_data;
1375         struct iwl_bcast_filter_cmd cmd;
1376         const struct iwl_fw_bcast_filter *filter;
1377         char *buf;
1378         int bufsz = 1024;
1379         int i, j, pos = 0;
1380         ssize_t ret;
1381
1382         buf = kzalloc(bufsz, GFP_KERNEL);
1383         if (!buf)
1384                 return -ENOMEM;
1385
1386         mutex_lock(&mvm->mutex);
1387         if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1388                 ADD_TEXT("None\n");
1389                 mutex_unlock(&mvm->mutex);
1390                 goto out;
1391         }
1392         mutex_unlock(&mvm->mutex);
1393
1394         for (i = 0; cmd.filters[i].attrs[0].mask; i++) {
1395                 filter = &cmd.filters[i];
1396
1397                 ADD_TEXT("Filter [%d]:\n", i);
1398                 ADD_TEXT("\tDiscard=%d\n", filter->discard);
1399                 ADD_TEXT("\tFrame Type: %s\n",
1400                          filter->frame_type ? "IPv4" : "Generic");
1401
1402                 for (j = 0; j < ARRAY_SIZE(filter->attrs); j++) {
1403                         const struct iwl_fw_bcast_filter_attr *attr;
1404
1405                         attr = &filter->attrs[j];
1406                         if (!attr->mask)
1407                                 break;
1408
1409                         ADD_TEXT("\tAttr [%d]: offset=%d (from %s), mask=0x%x, value=0x%x reserved=0x%x\n",
1410                                  j, attr->offset,
1411                                  attr->offset_type ? "IP End" :
1412                                                      "Payload Start",
1413                                  be32_to_cpu(attr->mask),
1414                                  be32_to_cpu(attr->val),
1415                                  le16_to_cpu(attr->reserved1));
1416                 }
1417         }
1418 out:
1419         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1420         kfree(buf);
1421         return ret;
1422 }
1423
1424 static ssize_t iwl_dbgfs_bcast_filters_write(struct iwl_mvm *mvm, char *buf,
1425                                              size_t count, loff_t *ppos)
1426 {
1427         int pos, next_pos;
1428         struct iwl_fw_bcast_filter filter = {};
1429         struct iwl_bcast_filter_cmd cmd;
1430         u32 filter_id, attr_id, mask, value;
1431         int err = 0;
1432
1433         if (sscanf(buf, "%d %hhi %hhi %n", &filter_id, &filter.discard,
1434                    &filter.frame_type, &pos) != 3)
1435                 return -EINVAL;
1436
1437         if (filter_id >= ARRAY_SIZE(mvm->dbgfs_bcast_filtering.cmd.filters) ||
1438             filter.frame_type > BCAST_FILTER_FRAME_TYPE_IPV4)
1439                 return -EINVAL;
1440
1441         for (attr_id = 0; attr_id < ARRAY_SIZE(filter.attrs);
1442              attr_id++) {
1443                 struct iwl_fw_bcast_filter_attr *attr =
1444                                 &filter.attrs[attr_id];
1445
1446                 if (pos >= count)
1447                         break;
1448
1449                 if (sscanf(&buf[pos], "%hhi %hhi %i %i %n",
1450                            &attr->offset, &attr->offset_type,
1451                            &mask, &value, &next_pos) != 4)
1452                         return -EINVAL;
1453
1454                 attr->mask = cpu_to_be32(mask);
1455                 attr->val = cpu_to_be32(value);
1456                 if (mask)
1457                         filter.num_attrs++;
1458
1459                 pos += next_pos;
1460         }
1461
1462         mutex_lock(&mvm->mutex);
1463         memcpy(&mvm->dbgfs_bcast_filtering.cmd.filters[filter_id],
1464                &filter, sizeof(filter));
1465
1466         /* send updated bcast filtering configuration */
1467         if (iwl_mvm_firmware_running(mvm) &&
1468             mvm->dbgfs_bcast_filtering.override &&
1469             iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1470                 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1471                                            sizeof(cmd), &cmd);
1472         mutex_unlock(&mvm->mutex);
1473
1474         return err ?: count;
1475 }
1476
1477 static ssize_t iwl_dbgfs_bcast_filters_macs_read(struct file *file,
1478                                                  char __user *user_buf,
1479                                                  size_t count, loff_t *ppos)
1480 {
1481         struct iwl_mvm *mvm = file->private_data;
1482         struct iwl_bcast_filter_cmd cmd;
1483         char *buf;
1484         int bufsz = 1024;
1485         int i, pos = 0;
1486         ssize_t ret;
1487
1488         buf = kzalloc(bufsz, GFP_KERNEL);
1489         if (!buf)
1490                 return -ENOMEM;
1491
1492         mutex_lock(&mvm->mutex);
1493         if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1494                 ADD_TEXT("None\n");
1495                 mutex_unlock(&mvm->mutex);
1496                 goto out;
1497         }
1498         mutex_unlock(&mvm->mutex);
1499
1500         for (i = 0; i < ARRAY_SIZE(cmd.macs); i++) {
1501                 const struct iwl_fw_bcast_mac *mac = &cmd.macs[i];
1502
1503                 ADD_TEXT("Mac [%d]: discard=%d attached_filters=0x%x\n",
1504                          i, mac->default_discard, mac->attached_filters);
1505         }
1506 out:
1507         ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1508         kfree(buf);
1509         return ret;
1510 }
1511
1512 static ssize_t iwl_dbgfs_bcast_filters_macs_write(struct iwl_mvm *mvm,
1513                                                   char *buf, size_t count,
1514                                                   loff_t *ppos)
1515 {
1516         struct iwl_bcast_filter_cmd cmd;
1517         struct iwl_fw_bcast_mac mac = {};
1518         u32 mac_id, attached_filters;
1519         int err = 0;
1520
1521         if (!mvm->bcast_filters)
1522                 return -ENOENT;
1523
1524         if (sscanf(buf, "%d %hhi %i", &mac_id, &mac.default_discard,
1525                    &attached_filters) != 3)
1526                 return -EINVAL;
1527
1528         if (mac_id >= ARRAY_SIZE(cmd.macs) ||
1529             mac.default_discard > 1 ||
1530             attached_filters >= BIT(ARRAY_SIZE(cmd.filters)))
1531                 return -EINVAL;
1532
1533         mac.attached_filters = cpu_to_le16(attached_filters);
1534
1535         mutex_lock(&mvm->mutex);
1536         memcpy(&mvm->dbgfs_bcast_filtering.cmd.macs[mac_id],
1537                &mac, sizeof(mac));
1538
1539         /* send updated bcast filtering configuration */
1540         if (iwl_mvm_firmware_running(mvm) &&
1541             mvm->dbgfs_bcast_filtering.override &&
1542             iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1543                 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1544                                            sizeof(cmd), &cmd);
1545         mutex_unlock(&mvm->mutex);
1546
1547         return err ?: count;
1548 }
1549 #endif
1550
1551 #define MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
1552         _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1553 #define MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
1554         _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1555 #define MVM_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do {      \
1556                 debugfs_create_file(alias, mode, parent, mvm,           \
1557                                     &iwl_dbgfs_##name##_ops);           \
1558         } while (0)
1559 #define MVM_DEBUGFS_ADD_FILE(name, parent, mode) \
1560         MVM_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
1561
1562 #define MVM_DEBUGFS_WRITE_STA_FILE_OPS(name, bufsz) \
1563         _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct ieee80211_sta)
1564 #define MVM_DEBUGFS_READ_WRITE_STA_FILE_OPS(name, bufsz) \
1565         _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct ieee80211_sta)
1566
1567 #define MVM_DEBUGFS_ADD_STA_FILE_ALIAS(alias, name, parent, mode) do {  \
1568                 debugfs_create_file(alias, mode, parent, sta,           \
1569                                     &iwl_dbgfs_##name##_ops);           \
1570         } while (0)
1571 #define MVM_DEBUGFS_ADD_STA_FILE(name, parent, mode) \
1572         MVM_DEBUGFS_ADD_STA_FILE_ALIAS(#name, name, parent, mode)
1573
1574 static ssize_t
1575 iwl_dbgfs_prph_reg_read(struct file *file,
1576                         char __user *user_buf,
1577                         size_t count, loff_t *ppos)
1578 {
1579         struct iwl_mvm *mvm = file->private_data;
1580         int pos = 0;
1581         char buf[32];
1582         const size_t bufsz = sizeof(buf);
1583
1584         if (!mvm->dbgfs_prph_reg_addr)
1585                 return -EINVAL;
1586
1587         pos += scnprintf(buf + pos, bufsz - pos, "Reg 0x%x: (0x%x)\n",
1588                 mvm->dbgfs_prph_reg_addr,
1589                 iwl_read_prph(mvm->trans, mvm->dbgfs_prph_reg_addr));
1590
1591         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1592 }
1593
1594 static ssize_t
1595 iwl_dbgfs_prph_reg_write(struct iwl_mvm *mvm, char *buf,
1596                          size_t count, loff_t *ppos)
1597 {
1598         u8 args;
1599         u32 value;
1600
1601         args = sscanf(buf, "%i %i", &mvm->dbgfs_prph_reg_addr, &value);
1602         /* if we only want to set the reg address - nothing more to do */
1603         if (args == 1)
1604                 goto out;
1605
1606         /* otherwise, make sure we have both address and value */
1607         if (args != 2)
1608                 return -EINVAL;
1609
1610         iwl_write_prph(mvm->trans, mvm->dbgfs_prph_reg_addr, value);
1611
1612 out:
1613         return count;
1614 }
1615
1616 static ssize_t
1617 iwl_dbgfs_send_echo_cmd_write(struct iwl_mvm *mvm, char *buf,
1618                               size_t count, loff_t *ppos)
1619 {
1620         int ret;
1621
1622         if (!iwl_mvm_firmware_running(mvm))
1623                 return -EIO;
1624
1625         mutex_lock(&mvm->mutex);
1626         ret = iwl_mvm_send_cmd_pdu(mvm, ECHO_CMD, 0, 0, NULL);
1627         mutex_unlock(&mvm->mutex);
1628
1629         return ret ?: count;
1630 }
1631
1632 struct iwl_mvm_sniffer_apply {
1633         struct iwl_mvm *mvm;
1634         u8 *bssid;
1635         u16 aid;
1636 };
1637
1638 static bool iwl_mvm_sniffer_apply(struct iwl_notif_wait_data *notif_data,
1639                                   struct iwl_rx_packet *pkt, void *data)
1640 {
1641         struct iwl_mvm_sniffer_apply *apply = data;
1642
1643         apply->mvm->cur_aid = cpu_to_le16(apply->aid);
1644         memcpy(apply->mvm->cur_bssid, apply->bssid,
1645                sizeof(apply->mvm->cur_bssid));
1646
1647         return true;
1648 }
1649
1650 static ssize_t
1651 iwl_dbgfs_he_sniffer_params_write(struct iwl_mvm *mvm, char *buf,
1652                                   size_t count, loff_t *ppos)
1653 {
1654         struct iwl_notification_wait wait;
1655         struct iwl_he_monitor_cmd he_mon_cmd = {};
1656         struct iwl_mvm_sniffer_apply apply = {
1657                 .mvm = mvm,
1658         };
1659         u16 wait_cmds[] = {
1660                 iwl_cmd_id(HE_AIR_SNIFFER_CONFIG_CMD, DATA_PATH_GROUP, 0),
1661         };
1662         u32 aid;
1663         int ret;
1664
1665         if (!iwl_mvm_firmware_running(mvm))
1666                 return -EIO;
1667
1668         ret = sscanf(buf, "%x %2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx", &aid,
1669                      &he_mon_cmd.bssid[0], &he_mon_cmd.bssid[1],
1670                      &he_mon_cmd.bssid[2], &he_mon_cmd.bssid[3],
1671                      &he_mon_cmd.bssid[4], &he_mon_cmd.bssid[5]);
1672         if (ret != 7)
1673                 return -EINVAL;
1674
1675         he_mon_cmd.aid = cpu_to_le16(aid);
1676
1677         apply.aid = aid;
1678         apply.bssid = (void *)he_mon_cmd.bssid;
1679
1680         mutex_lock(&mvm->mutex);
1681
1682         /*
1683          * Use the notification waiter to get our function triggered
1684          * in sequence with other RX. This ensures that frames we get
1685          * on the RX queue _before_ the new configuration is applied
1686          * still have mvm->cur_aid pointing to the old AID, and that
1687          * frames on the RX queue _after_ the firmware processed the
1688          * new configuration (and sent the response, synchronously)
1689          * get mvm->cur_aid correctly set to the new AID.
1690          */
1691         iwl_init_notification_wait(&mvm->notif_wait, &wait,
1692                                    wait_cmds, ARRAY_SIZE(wait_cmds),
1693                                    iwl_mvm_sniffer_apply, &apply);
1694
1695         ret = iwl_mvm_send_cmd_pdu(mvm, iwl_cmd_id(HE_AIR_SNIFFER_CONFIG_CMD,
1696                                                    DATA_PATH_GROUP, 0), 0,
1697                                    sizeof(he_mon_cmd), &he_mon_cmd);
1698
1699         /* no need to really wait, we already did anyway */
1700         iwl_remove_notification(&mvm->notif_wait, &wait);
1701
1702         mutex_unlock(&mvm->mutex);
1703
1704         return ret ?: count;
1705 }
1706
1707 static ssize_t
1708 iwl_dbgfs_he_sniffer_params_read(struct file *file, char __user *user_buf,
1709                                  size_t count, loff_t *ppos)
1710 {
1711         struct iwl_mvm *mvm = file->private_data;
1712         u8 buf[32];
1713         int len;
1714
1715         len = scnprintf(buf, sizeof(buf),
1716                         "%d %02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx\n",
1717                         le16_to_cpu(mvm->cur_aid), mvm->cur_bssid[0],
1718                         mvm->cur_bssid[1], mvm->cur_bssid[2], mvm->cur_bssid[3],
1719                         mvm->cur_bssid[4], mvm->cur_bssid[5]);
1720
1721         return simple_read_from_buffer(user_buf, count, ppos, buf, len);
1722 }
1723
1724 static ssize_t
1725 iwl_dbgfs_uapsd_noagg_bssids_read(struct file *file, char __user *user_buf,
1726                                   size_t count, loff_t *ppos)
1727 {
1728         struct iwl_mvm *mvm = file->private_data;
1729         u8 buf[IWL_MVM_UAPSD_NOAGG_BSSIDS_NUM * ETH_ALEN * 3 + 1];
1730         unsigned int pos = 0;
1731         size_t bufsz = sizeof(buf);
1732         int i;
1733
1734         mutex_lock(&mvm->mutex);
1735
1736         for (i = 0; i < IWL_MVM_UAPSD_NOAGG_LIST_LEN; i++)
1737                 pos += scnprintf(buf + pos, bufsz - pos, "%pM\n",
1738                                  mvm->uapsd_noagg_bssids[i].addr);
1739
1740         mutex_unlock(&mvm->mutex);
1741
1742         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1743 }
1744
1745 static ssize_t
1746 iwl_dbgfs_ltr_config_write(struct iwl_mvm *mvm,
1747                            char *buf, size_t count, loff_t *ppos)
1748 {
1749         int ret;
1750         struct iwl_ltr_config_cmd ltr_config = {0};
1751
1752         if (!iwl_mvm_firmware_running(mvm))
1753                 return -EIO;
1754
1755         if (sscanf(buf, "%x,%x,%x,%x,%x,%x,%x",
1756                    &ltr_config.flags,
1757                    &ltr_config.static_long,
1758                    &ltr_config.static_short,
1759                    &ltr_config.ltr_cfg_values[0],
1760                    &ltr_config.ltr_cfg_values[1],
1761                    &ltr_config.ltr_cfg_values[2],
1762                    &ltr_config.ltr_cfg_values[3]) != 7) {
1763                 return -EINVAL;
1764         }
1765
1766         mutex_lock(&mvm->mutex);
1767         ret = iwl_mvm_send_cmd_pdu(mvm, LTR_CONFIG, 0, sizeof(ltr_config),
1768                                    &ltr_config);
1769         mutex_unlock(&mvm->mutex);
1770
1771         if (ret)
1772                 IWL_ERR(mvm, "failed to send ltr configuration cmd\n");
1773
1774         return ret ?: count;
1775 }
1776
1777 static ssize_t iwl_dbgfs_rfi_freq_table_write(struct iwl_mvm *mvm, char *buf,
1778                                               size_t count, loff_t *ppos)
1779 {
1780         int ret = 0;
1781         u16 op_id;
1782
1783         if (kstrtou16(buf, 10, &op_id))
1784                 return -EINVAL;
1785
1786         /* value zero triggers re-sending the default table to the device */
1787         if (!op_id) {
1788                 mutex_lock(&mvm->mutex);
1789                 ret = iwl_rfi_send_config_cmd(mvm, NULL);
1790                 mutex_unlock(&mvm->mutex);
1791         } else {
1792                 ret = -EOPNOTSUPP; /* in the future a new table will be added */
1793         }
1794
1795         return ret ?: count;
1796 }
1797
1798 /* The size computation is as follows:
1799  * each number needs at most 3 characters, number of rows is the size of
1800  * the table; So, need 5 chars for the "freq: " part and each tuple afterwards
1801  * needs 6 characters for numbers and 5 for the punctuation around.
1802  */
1803 #define IWL_RFI_BUF_SIZE (IWL_RFI_LUT_INSTALLED_SIZE *\
1804                                 (5 + IWL_RFI_LUT_ENTRY_CHANNELS_NUM * (6 + 5)))
1805
1806 static ssize_t iwl_dbgfs_rfi_freq_table_read(struct file *file,
1807                                              char __user *user_buf,
1808                                              size_t count, loff_t *ppos)
1809 {
1810         struct iwl_mvm *mvm = file->private_data;
1811         struct iwl_rfi_freq_table_resp_cmd *resp;
1812         u32 status;
1813         char buf[IWL_RFI_BUF_SIZE];
1814         int i, j, pos = 0;
1815
1816         resp = iwl_rfi_get_freq_table(mvm);
1817         if (IS_ERR(resp))
1818                 return PTR_ERR(resp);
1819
1820         status = le32_to_cpu(resp->status);
1821         if (status != RFI_FREQ_TABLE_OK) {
1822                 scnprintf(buf, IWL_RFI_BUF_SIZE, "status = %d\n", status);
1823                 goto out;
1824         }
1825
1826         for (i = 0; i < ARRAY_SIZE(resp->table); i++) {
1827                 pos += scnprintf(buf + pos, IWL_RFI_BUF_SIZE - pos, "%d: ",
1828                                  resp->table[i].freq);
1829
1830                 for (j = 0; j < ARRAY_SIZE(resp->table[i].channels); j++)
1831                         pos += scnprintf(buf + pos, IWL_RFI_BUF_SIZE - pos,
1832                                          "(%d, %d) ",
1833                                          resp->table[i].channels[j],
1834                                          resp->table[i].bands[j]);
1835                 pos += scnprintf(buf + pos, IWL_RFI_BUF_SIZE - pos, "\n");
1836         }
1837
1838 out:
1839         kfree(resp);
1840         return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1841 }
1842
1843 MVM_DEBUGFS_READ_WRITE_FILE_OPS(prph_reg, 64);
1844
1845 /* Device wide debugfs entries */
1846 MVM_DEBUGFS_READ_FILE_OPS(ctdp_budget);
1847 MVM_DEBUGFS_WRITE_FILE_OPS(stop_ctdp, 8);
1848 MVM_DEBUGFS_WRITE_FILE_OPS(force_ctkill, 8);
1849 MVM_DEBUGFS_WRITE_FILE_OPS(tx_flush, 16);
1850 MVM_DEBUGFS_WRITE_FILE_OPS(sta_drain, 8);
1851 MVM_DEBUGFS_WRITE_FILE_OPS(send_echo_cmd, 8);
1852 MVM_DEBUGFS_READ_WRITE_FILE_OPS(sram, 64);
1853 MVM_DEBUGFS_READ_WRITE_FILE_OPS(set_nic_temperature, 64);
1854 MVM_DEBUGFS_READ_FILE_OPS(nic_temp);
1855 MVM_DEBUGFS_READ_FILE_OPS(stations);
1856 MVM_DEBUGFS_READ_FILE_OPS(rs_data);
1857 MVM_DEBUGFS_READ_FILE_OPS(bt_notif);
1858 MVM_DEBUGFS_READ_FILE_OPS(bt_cmd);
1859 MVM_DEBUGFS_READ_WRITE_FILE_OPS(disable_power_off, 64);
1860 MVM_DEBUGFS_READ_FILE_OPS(fw_rx_stats);
1861 MVM_DEBUGFS_READ_FILE_OPS(drv_rx_stats);
1862 MVM_DEBUGFS_READ_FILE_OPS(fw_ver);
1863 MVM_DEBUGFS_READ_FILE_OPS(phy_integration_ver);
1864 MVM_DEBUGFS_WRITE_FILE_OPS(fw_restart, 10);
1865 MVM_DEBUGFS_WRITE_FILE_OPS(fw_nmi, 10);
1866 MVM_DEBUGFS_WRITE_FILE_OPS(bt_tx_prio, 10);
1867 MVM_DEBUGFS_WRITE_FILE_OPS(bt_force_ant, 10);
1868 MVM_DEBUGFS_READ_WRITE_FILE_OPS(scan_ant_rxchain, 8);
1869 MVM_DEBUGFS_READ_WRITE_FILE_OPS(fw_dbg_conf, 8);
1870 MVM_DEBUGFS_WRITE_FILE_OPS(fw_dbg_collect, 64);
1871 MVM_DEBUGFS_WRITE_FILE_OPS(dbg_time_point, 64);
1872 MVM_DEBUGFS_WRITE_FILE_OPS(indirection_tbl,
1873                            (IWL_RSS_INDIRECTION_TABLE_SIZE * 2));
1874 MVM_DEBUGFS_WRITE_FILE_OPS(inject_packet, 512);
1875 MVM_DEBUGFS_WRITE_FILE_OPS(inject_beacon_ie, 512);
1876 MVM_DEBUGFS_WRITE_FILE_OPS(inject_beacon_ie_restore, 512);
1877
1878 MVM_DEBUGFS_READ_FILE_OPS(uapsd_noagg_bssids);
1879
1880 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1881 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters, 256);
1882 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters_macs, 256);
1883 #endif
1884
1885 #ifdef CONFIG_ACPI
1886 MVM_DEBUGFS_READ_FILE_OPS(sar_geo_profile);
1887 #endif
1888
1889 MVM_DEBUGFS_READ_WRITE_STA_FILE_OPS(amsdu_len, 16);
1890
1891 MVM_DEBUGFS_READ_WRITE_FILE_OPS(he_sniffer_params, 32);
1892
1893 MVM_DEBUGFS_WRITE_FILE_OPS(ltr_config, 512);
1894 MVM_DEBUGFS_READ_WRITE_FILE_OPS(rfi_freq_table, 16);
1895
1896 static ssize_t iwl_dbgfs_mem_read(struct file *file, char __user *user_buf,
1897                                   size_t count, loff_t *ppos)
1898 {
1899         struct iwl_mvm *mvm = file->private_data;
1900         struct iwl_dbg_mem_access_cmd cmd = {};
1901         struct iwl_dbg_mem_access_rsp *rsp;
1902         struct iwl_host_cmd hcmd = {
1903                 .flags = CMD_WANT_SKB | CMD_SEND_IN_RFKILL,
1904                 .data = { &cmd, },
1905                 .len = { sizeof(cmd) },
1906         };
1907         size_t delta;
1908         ssize_t ret, len;
1909
1910         if (!iwl_mvm_firmware_running(mvm))
1911                 return -EIO;
1912
1913         hcmd.id = iwl_cmd_id(*ppos >> 24 ? UMAC_RD_WR : LMAC_RD_WR,
1914                              DEBUG_GROUP, 0);
1915         cmd.op = cpu_to_le32(DEBUG_MEM_OP_READ);
1916
1917         /* Take care of alignment of both the position and the length */
1918         delta = *ppos & 0x3;
1919         cmd.addr = cpu_to_le32(*ppos - delta);
1920         cmd.len = cpu_to_le32(min(ALIGN(count + delta, 4) / 4,
1921                                   (size_t)DEBUG_MEM_MAX_SIZE_DWORDS));
1922
1923         mutex_lock(&mvm->mutex);
1924         ret = iwl_mvm_send_cmd(mvm, &hcmd);
1925         mutex_unlock(&mvm->mutex);
1926
1927         if (ret < 0)
1928                 return ret;
1929
1930         rsp = (void *)hcmd.resp_pkt->data;
1931         if (le32_to_cpu(rsp->status) != DEBUG_MEM_STATUS_SUCCESS) {
1932                 ret = -ENXIO;
1933                 goto out;
1934         }
1935
1936         len = min((size_t)le32_to_cpu(rsp->len) << 2,
1937                   iwl_rx_packet_payload_len(hcmd.resp_pkt) - sizeof(*rsp));
1938         len = min(len - delta, count);
1939         if (len < 0) {
1940                 ret = -EFAULT;
1941                 goto out;
1942         }
1943
1944         ret = len - copy_to_user(user_buf, (void *)rsp->data + delta, len);
1945         *ppos += ret;
1946
1947 out:
1948         iwl_free_resp(&hcmd);
1949         return ret;
1950 }
1951
1952 static ssize_t iwl_dbgfs_mem_write(struct file *file,
1953                                    const char __user *user_buf, size_t count,
1954                                    loff_t *ppos)
1955 {
1956         struct iwl_mvm *mvm = file->private_data;
1957         struct iwl_dbg_mem_access_cmd *cmd;
1958         struct iwl_dbg_mem_access_rsp *rsp;
1959         struct iwl_host_cmd hcmd = {};
1960         size_t cmd_size;
1961         size_t data_size;
1962         u32 op, len;
1963         ssize_t ret;
1964
1965         if (!iwl_mvm_firmware_running(mvm))
1966                 return -EIO;
1967
1968         hcmd.id = iwl_cmd_id(*ppos >> 24 ? UMAC_RD_WR : LMAC_RD_WR,
1969                              DEBUG_GROUP, 0);
1970
1971         if (*ppos & 0x3 || count < 4) {
1972                 op = DEBUG_MEM_OP_WRITE_BYTES;
1973                 len = min(count, (size_t)(4 - (*ppos & 0x3)));
1974                 data_size = len;
1975         } else {
1976                 op = DEBUG_MEM_OP_WRITE;
1977                 len = min(count >> 2, (size_t)DEBUG_MEM_MAX_SIZE_DWORDS);
1978                 data_size = len << 2;
1979         }
1980
1981         cmd_size = sizeof(*cmd) + ALIGN(data_size, 4);
1982         cmd = kzalloc(cmd_size, GFP_KERNEL);
1983         if (!cmd)
1984                 return -ENOMEM;
1985
1986         cmd->op = cpu_to_le32(op);
1987         cmd->len = cpu_to_le32(len);
1988         cmd->addr = cpu_to_le32(*ppos);
1989         if (copy_from_user((void *)cmd->data, user_buf, data_size)) {
1990                 kfree(cmd);
1991                 return -EFAULT;
1992         }
1993
1994         hcmd.flags = CMD_WANT_SKB | CMD_SEND_IN_RFKILL,
1995         hcmd.data[0] = (void *)cmd;
1996         hcmd.len[0] = cmd_size;
1997
1998         mutex_lock(&mvm->mutex);
1999         ret = iwl_mvm_send_cmd(mvm, &hcmd);
2000         mutex_unlock(&mvm->mutex);
2001
2002         kfree(cmd);
2003
2004         if (ret < 0)
2005                 return ret;
2006
2007         rsp = (void *)hcmd.resp_pkt->data;
2008         if (rsp->status != DEBUG_MEM_STATUS_SUCCESS) {
2009                 ret = -ENXIO;
2010                 goto out;
2011         }
2012
2013         ret = data_size;
2014         *ppos += ret;
2015
2016 out:
2017         iwl_free_resp(&hcmd);
2018         return ret;
2019 }
2020
2021 static const struct file_operations iwl_dbgfs_mem_ops = {
2022         .read = iwl_dbgfs_mem_read,
2023         .write = iwl_dbgfs_mem_write,
2024         .open = simple_open,
2025         .llseek = default_llseek,
2026 };
2027
2028 void iwl_mvm_sta_add_debugfs(struct ieee80211_hw *hw,
2029                              struct ieee80211_vif *vif,
2030                              struct ieee80211_sta *sta,
2031                              struct dentry *dir)
2032 {
2033         struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2034
2035         if (iwl_mvm_has_tlc_offload(mvm)) {
2036                 MVM_DEBUGFS_ADD_STA_FILE(rs_data, dir, 0400);
2037         }
2038         MVM_DEBUGFS_ADD_STA_FILE(amsdu_len, dir, 0600);
2039 }
2040
2041 void iwl_mvm_dbgfs_register(struct iwl_mvm *mvm)
2042 {
2043         struct dentry *bcast_dir __maybe_unused;
2044         char buf[100];
2045
2046         spin_lock_init(&mvm->drv_stats_lock);
2047
2048         MVM_DEBUGFS_ADD_FILE(tx_flush, mvm->debugfs_dir, 0200);
2049         MVM_DEBUGFS_ADD_FILE(sta_drain, mvm->debugfs_dir, 0200);
2050         MVM_DEBUGFS_ADD_FILE(sram, mvm->debugfs_dir, 0600);
2051         MVM_DEBUGFS_ADD_FILE(set_nic_temperature, mvm->debugfs_dir, 0600);
2052         MVM_DEBUGFS_ADD_FILE(nic_temp, mvm->debugfs_dir, 0400);
2053         MVM_DEBUGFS_ADD_FILE(ctdp_budget, mvm->debugfs_dir, 0400);
2054         MVM_DEBUGFS_ADD_FILE(stop_ctdp, mvm->debugfs_dir, 0200);
2055         MVM_DEBUGFS_ADD_FILE(force_ctkill, mvm->debugfs_dir, 0200);
2056         MVM_DEBUGFS_ADD_FILE(stations, mvm->debugfs_dir, 0400);
2057         MVM_DEBUGFS_ADD_FILE(bt_notif, mvm->debugfs_dir, 0400);
2058         MVM_DEBUGFS_ADD_FILE(bt_cmd, mvm->debugfs_dir, 0400);
2059         MVM_DEBUGFS_ADD_FILE(disable_power_off, mvm->debugfs_dir, 0600);
2060         MVM_DEBUGFS_ADD_FILE(fw_ver, mvm->debugfs_dir, 0400);
2061         MVM_DEBUGFS_ADD_FILE(fw_rx_stats, mvm->debugfs_dir, 0400);
2062         MVM_DEBUGFS_ADD_FILE(drv_rx_stats, mvm->debugfs_dir, 0400);
2063         MVM_DEBUGFS_ADD_FILE(fw_restart, mvm->debugfs_dir, 0200);
2064         MVM_DEBUGFS_ADD_FILE(fw_nmi, mvm->debugfs_dir, 0200);
2065         MVM_DEBUGFS_ADD_FILE(bt_tx_prio, mvm->debugfs_dir, 0200);
2066         MVM_DEBUGFS_ADD_FILE(bt_force_ant, mvm->debugfs_dir, 0200);
2067         MVM_DEBUGFS_ADD_FILE(scan_ant_rxchain, mvm->debugfs_dir, 0600);
2068         MVM_DEBUGFS_ADD_FILE(prph_reg, mvm->debugfs_dir, 0600);
2069         MVM_DEBUGFS_ADD_FILE(fw_dbg_conf, mvm->debugfs_dir, 0600);
2070         MVM_DEBUGFS_ADD_FILE(fw_dbg_collect, mvm->debugfs_dir, 0200);
2071         MVM_DEBUGFS_ADD_FILE(send_echo_cmd, mvm->debugfs_dir, 0200);
2072         MVM_DEBUGFS_ADD_FILE(indirection_tbl, mvm->debugfs_dir, 0200);
2073         MVM_DEBUGFS_ADD_FILE(inject_packet, mvm->debugfs_dir, 0200);
2074         MVM_DEBUGFS_ADD_FILE(inject_beacon_ie, mvm->debugfs_dir, 0200);
2075         MVM_DEBUGFS_ADD_FILE(inject_beacon_ie_restore, mvm->debugfs_dir, 0200);
2076         MVM_DEBUGFS_ADD_FILE(rfi_freq_table, mvm->debugfs_dir, 0600);
2077
2078         if (mvm->fw->phy_integration_ver)
2079                 MVM_DEBUGFS_ADD_FILE(phy_integration_ver, mvm->debugfs_dir, 0400);
2080 #ifdef CONFIG_ACPI
2081         MVM_DEBUGFS_ADD_FILE(sar_geo_profile, mvm->debugfs_dir, 0400);
2082 #endif
2083         MVM_DEBUGFS_ADD_FILE(he_sniffer_params, mvm->debugfs_dir, 0600);
2084
2085         if (fw_has_capa(&mvm->fw->ucode_capa, IWL_UCODE_TLV_CAPA_SET_LTR_GEN2))
2086                 MVM_DEBUGFS_ADD_FILE(ltr_config, mvm->debugfs_dir, 0200);
2087
2088         debugfs_create_bool("enable_scan_iteration_notif", 0600,
2089                             mvm->debugfs_dir, &mvm->scan_iter_notif_enabled);
2090         debugfs_create_bool("drop_bcn_ap_mode", 0600, mvm->debugfs_dir,
2091                             &mvm->drop_bcn_ap_mode);
2092
2093         MVM_DEBUGFS_ADD_FILE(uapsd_noagg_bssids, mvm->debugfs_dir, S_IRUSR);
2094
2095 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
2096         if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING) {
2097                 bcast_dir = debugfs_create_dir("bcast_filtering",
2098                                                mvm->debugfs_dir);
2099
2100                 debugfs_create_bool("override", 0600, bcast_dir,
2101                                     &mvm->dbgfs_bcast_filtering.override);
2102
2103                 MVM_DEBUGFS_ADD_FILE_ALIAS("filters", bcast_filters,
2104                                            bcast_dir, 0600);
2105                 MVM_DEBUGFS_ADD_FILE_ALIAS("macs", bcast_filters_macs,
2106                                            bcast_dir, 0600);
2107         }
2108 #endif
2109
2110 #ifdef CONFIG_PM_SLEEP
2111         MVM_DEBUGFS_ADD_FILE(d3_test, mvm->debugfs_dir, 0400);
2112         debugfs_create_bool("d3_wake_sysassert", 0600, mvm->debugfs_dir,
2113                             &mvm->d3_wake_sysassert);
2114         debugfs_create_u32("last_netdetect_scans", 0400, mvm->debugfs_dir,
2115                            &mvm->last_netdetect_scans);
2116 #endif
2117
2118         debugfs_create_u8("ps_disabled", 0400, mvm->debugfs_dir,
2119                           &mvm->ps_disabled);
2120         debugfs_create_blob("nvm_hw", 0400, mvm->debugfs_dir,
2121                             &mvm->nvm_hw_blob);
2122         debugfs_create_blob("nvm_sw", 0400, mvm->debugfs_dir,
2123                             &mvm->nvm_sw_blob);
2124         debugfs_create_blob("nvm_calib", 0400, mvm->debugfs_dir,
2125                             &mvm->nvm_calib_blob);
2126         debugfs_create_blob("nvm_prod", 0400, mvm->debugfs_dir,
2127                             &mvm->nvm_prod_blob);
2128         debugfs_create_blob("nvm_phy_sku", 0400, mvm->debugfs_dir,
2129                             &mvm->nvm_phy_sku_blob);
2130         debugfs_create_blob("nvm_reg", S_IRUSR,
2131                             mvm->debugfs_dir, &mvm->nvm_reg_blob);
2132
2133         debugfs_create_file("mem", 0600, mvm->debugfs_dir, mvm,
2134                             &iwl_dbgfs_mem_ops);
2135
2136         /*
2137          * Create a symlink with mac80211. It will be removed when mac80211
2138          * exists (before the opmode exists which removes the target.)
2139          */
2140         snprintf(buf, 100, "../../%pd2", mvm->debugfs_dir->d_parent);
2141         debugfs_create_symlink("iwlwifi", mvm->hw->wiphy->debugfsdir, buf);
2142 }