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