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