?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
net/mlx4_en: Move filters cleanup to a proper location
[linux/fpc-iii.git] / drivers / net / wireless / intel / iwlwifi / mvm / debugfs.c
blob406cf1cb945cfe330be0185f17dd7cd9f173cd53
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 Intel Deutschland GmbH
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of version 2 of the GNU General Public License as
14 * published by the Free Software Foundation.
15 *
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
24 * USA
25 *
26 * The full GNU General Public License is included in this distribution
27 * in the file called COPYING.
28 *
29 * Contact Information:
30 * Intel Linux Wireless <linuxwifi@intel.com>
31 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
32 *
33 * BSD LICENSE
34 *
35 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
36 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
37 * All rights reserved.
38 *
39 * Redistribution and use in source and binary forms, with or without
40 * modification, are permitted provided that the following conditions
41 * are met:
42 *
43 * * Redistributions of source code must retain the above copyright
44 * notice, this list of conditions and the following disclaimer.
45 * * Redistributions in binary form must reproduce the above copyright
46 * notice, this list of conditions and the following disclaimer in
47 * the documentation and/or other materials provided with the
48 * distribution.
49 * * Neither the name Intel Corporation nor the names of its
50 * contributors may be used to endorse or promote products derived
51 * from this software without specific prior written permission.
52 *
53 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
54 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
55 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
56 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
57 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
58 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
59 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
60 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
61 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
62 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
63 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
64 *
65 *****************************************************************************/
66 #include <linux/vmalloc.h>
67 #include <linux/ieee80211.h>
68 #include <linux/netdevice.h>
69
70 #include "mvm.h"
71 #include "fw-dbg.h"
72 #include "sta.h"
73 #include "iwl-io.h"
74 #include "debugfs.h"
75 #include "iwl-fw-error-dump.h"
76
77 static ssize_t iwl_dbgfs_ctdp_budget_read(struct file *file,
78 char __user *user_buf,
79 size_t count, loff_t *ppos)
80 {
81 struct iwl_mvm *mvm = file->private_data;
82 char buf[16];
83 int pos, budget;
84
85 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR)
86 return -EIO;
87
88 mutex_lock(&mvm->mutex);
89 budget = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_REPORT, 0);
90 mutex_unlock(&mvm->mutex);
91
92 if (budget < 0)
93 return budget;
94
95 pos = scnprintf(buf, sizeof(buf), "%d\n", budget);
96
97 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
98 }
99
100 static ssize_t iwl_dbgfs_stop_ctdp_write(struct iwl_mvm *mvm, char *buf,
101 size_t count, loff_t *ppos)
102 {
103 int ret;
104
105 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR)
106 return -EIO;
107
108 mutex_lock(&mvm->mutex);
109 ret = iwl_mvm_ctdp_command(mvm, CTDP_CMD_OPERATION_STOP, 0);
110 mutex_unlock(&mvm->mutex);
111
112 return ret ?: count;
113 }
114
115 static ssize_t iwl_dbgfs_tx_flush_write(struct iwl_mvm *mvm, char *buf,
116 size_t count, loff_t *ppos)
117 {
118 int ret;
119 u32 scd_q_msk;
120
121 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR)
122 return -EIO;
123
124 if (sscanf(buf, "%x", &scd_q_msk) != 1)
125 return -EINVAL;
126
127 IWL_ERR(mvm, "FLUSHING queues: scd_q_msk = 0x%x\n", scd_q_msk);
128
129 mutex_lock(&mvm->mutex);
130 ret = iwl_mvm_flush_tx_path(mvm, scd_q_msk, 0) ? : count;
131 mutex_unlock(&mvm->mutex);
132
133 return ret;
134 }
135
136 static ssize_t iwl_dbgfs_sta_drain_write(struct iwl_mvm *mvm, char *buf,
137 size_t count, loff_t *ppos)
138 {
139 struct iwl_mvm_sta *mvmsta;
140 int sta_id, drain, ret;
141
142 if (!mvm->ucode_loaded || mvm->cur_ucode != IWL_UCODE_REGULAR)
143 return -EIO;
144
145 if (sscanf(buf, "%d %d", &sta_id, &drain) != 2)
146 return -EINVAL;
147 if (sta_id < 0 || sta_id >= IWL_MVM_STATION_COUNT)
148 return -EINVAL;
149 if (drain < 0 || drain > 1)
150 return -EINVAL;
151
152 mutex_lock(&mvm->mutex);
153
154 mvmsta = iwl_mvm_sta_from_staid_protected(mvm, sta_id);
155
156 if (!mvmsta)
157 ret = -ENOENT;
158 else
159 ret = iwl_mvm_drain_sta(mvm, mvmsta, drain) ? : count;
160
161 mutex_unlock(&mvm->mutex);
162
163 return ret;
164 }
165
166 static ssize_t iwl_dbgfs_sram_read(struct file *file, char __user *user_buf,
167 size_t count, loff_t *ppos)
168 {
169 struct iwl_mvm *mvm = file->private_data;
170 const struct fw_img *img;
171 unsigned int ofs, len;
172 size_t ret;
173 u8 *ptr;
174
175 if (!mvm->ucode_loaded)
176 return -EINVAL;
177
178 /* default is to dump the entire data segment */
179 img = &mvm->fw->img[mvm->cur_ucode];
180 ofs = img->sec[IWL_UCODE_SECTION_DATA].offset;
181 len = img->sec[IWL_UCODE_SECTION_DATA].len;
182
183 if (mvm->dbgfs_sram_len) {
184 ofs = mvm->dbgfs_sram_offset;
185 len = mvm->dbgfs_sram_len;
186 }
187
188 ptr = kzalloc(len, GFP_KERNEL);
189 if (!ptr)
190 return -ENOMEM;
191
192 iwl_trans_read_mem_bytes(mvm->trans, ofs, ptr, len);
193
194 ret = simple_read_from_buffer(user_buf, count, ppos, ptr, len);
195
196 kfree(ptr);
197
198 return ret;
199 }
200
201 static ssize_t iwl_dbgfs_sram_write(struct iwl_mvm *mvm, char *buf,
202 size_t count, loff_t *ppos)
203 {
204 const struct fw_img *img;
205 u32 offset, len;
206 u32 img_offset, img_len;
207
208 if (!mvm->ucode_loaded)
209 return -EINVAL;
210
211 img = &mvm->fw->img[mvm->cur_ucode];
212 img_offset = img->sec[IWL_UCODE_SECTION_DATA].offset;
213 img_len = img->sec[IWL_UCODE_SECTION_DATA].len;
214
215 if (sscanf(buf, "%x,%x", &offset, &len) == 2) {
216 if ((offset & 0x3) || (len & 0x3))
217 return -EINVAL;
218
219 if (offset + len > img_offset + img_len)
220 return -EINVAL;
221
222 mvm->dbgfs_sram_offset = offset;
223 mvm->dbgfs_sram_len = len;
224 } else {
225 mvm->dbgfs_sram_offset = 0;
226 mvm->dbgfs_sram_len = 0;
227 }
228
229 return count;
230 }
231
232 static ssize_t iwl_dbgfs_set_nic_temperature_read(struct file *file,
233 char __user *user_buf,
234 size_t count, loff_t *ppos)
235 {
236 struct iwl_mvm *mvm = file->private_data;
237 char buf[16];
238 int pos;
239
240 if (!mvm->temperature_test)
241 pos = scnprintf(buf , sizeof(buf), "disabled\n");
242 else
243 pos = scnprintf(buf , sizeof(buf), "%d\n", mvm->temperature);
244
245 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
246 }
247
248 /*
249 * Set NIC Temperature
250 * Cause the driver to ignore the actual NIC temperature reported by the FW
251 * Enable: any value between IWL_MVM_DEBUG_SET_TEMPERATURE_MIN -
252 * IWL_MVM_DEBUG_SET_TEMPERATURE_MAX
253 * Disable: IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE
254 */
255 static ssize_t iwl_dbgfs_set_nic_temperature_write(struct iwl_mvm *mvm,
256 char *buf, size_t count,
257 loff_t *ppos)
258 {
259 int temperature;
260
261 if (!mvm->ucode_loaded && !mvm->temperature_test)
262 return -EIO;
263
264 if (kstrtoint(buf, 10, &temperature))
265 return -EINVAL;
266 /* not a legal temperature */
267 if ((temperature > IWL_MVM_DEBUG_SET_TEMPERATURE_MAX &&
268 temperature != IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) ||
269 temperature < IWL_MVM_DEBUG_SET_TEMPERATURE_MIN)
270 return -EINVAL;
271
272 mutex_lock(&mvm->mutex);
273 if (temperature == IWL_MVM_DEBUG_SET_TEMPERATURE_DISABLE) {
274 if (!mvm->temperature_test)
275 goto out;
276
277 mvm->temperature_test = false;
278 /* Since we can't read the temp while awake, just set
279 * it to zero until we get the next RX stats from the
280 * firmware.
281 */
282 mvm->temperature = 0;
283 } else {
284 mvm->temperature_test = true;
285 mvm->temperature = temperature;
286 }
287 IWL_DEBUG_TEMP(mvm, "%sabling debug set temperature (temp = %d)\n",
288 mvm->temperature_test ? "En" : "Dis" ,
289 mvm->temperature);
290 /* handle the temperature change */
291 iwl_mvm_tt_handler(mvm);
292
293 out:
294 mutex_unlock(&mvm->mutex);
295
296 return count;
297 }
298
299 static ssize_t iwl_dbgfs_nic_temp_read(struct file *file,
300 char __user *user_buf,
301 size_t count, loff_t *ppos)
302 {
303 struct iwl_mvm *mvm = file->private_data;
304 char buf[16];
305 int pos, ret;
306 s32 temp;
307
308 if (!mvm->ucode_loaded)
309 return -EIO;
310
311 mutex_lock(&mvm->mutex);
312 ret = iwl_mvm_get_temp(mvm, &temp);
313 mutex_unlock(&mvm->mutex);
314
315 if (ret)
316 return -EIO;
317
318 pos = scnprintf(buf , sizeof(buf), "%d\n", temp);
319
320 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
321 }
322
323 static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf,
324 size_t count, loff_t *ppos)
325 {
326 struct iwl_mvm *mvm = file->private_data;
327 struct ieee80211_sta *sta;
328 char buf[400];
329 int i, pos = 0, bufsz = sizeof(buf);
330
331 mutex_lock(&mvm->mutex);
332
333 for (i = 0; i < IWL_MVM_STATION_COUNT; i++) {
334 pos += scnprintf(buf + pos, bufsz - pos, "%.2d: ", i);
335 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[i],
336 lockdep_is_held(&mvm->mutex));
337 if (!sta)
338 pos += scnprintf(buf + pos, bufsz - pos, "N/A\n");
339 else if (IS_ERR(sta))
340 pos += scnprintf(buf + pos, bufsz - pos, "%ld\n",
341 PTR_ERR(sta));
342 else
343 pos += scnprintf(buf + pos, bufsz - pos, "%pM\n",
344 sta->addr);
345 }
346
347 mutex_unlock(&mvm->mutex);
348
349 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
350 }
351
352 static ssize_t iwl_dbgfs_disable_power_off_read(struct file *file,
353 char __user *user_buf,
354 size_t count, loff_t *ppos)
355 {
356 struct iwl_mvm *mvm = file->private_data;
357 char buf[64];
358 int bufsz = sizeof(buf);
359 int pos = 0;
360
361 pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d0=%d\n",
362 mvm->disable_power_off);
363 pos += scnprintf(buf+pos, bufsz-pos, "disable_power_off_d3=%d\n",
364 mvm->disable_power_off_d3);
365
366 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
367 }
368
369 static ssize_t iwl_dbgfs_disable_power_off_write(struct iwl_mvm *mvm, char *buf,
370 size_t count, loff_t *ppos)
371 {
372 int ret, val;
373
374 if (!mvm->ucode_loaded)
375 return -EIO;
376
377 if (!strncmp("disable_power_off_d0=", buf, 21)) {
378 if (sscanf(buf + 21, "%d", &val) != 1)
379 return -EINVAL;
380 mvm->disable_power_off = val;
381 } else if (!strncmp("disable_power_off_d3=", buf, 21)) {
382 if (sscanf(buf + 21, "%d", &val) != 1)
383 return -EINVAL;
384 mvm->disable_power_off_d3 = val;
385 } else {
386 return -EINVAL;
387 }
388
389 mutex_lock(&mvm->mutex);
390 ret = iwl_mvm_power_update_device(mvm);
391 mutex_unlock(&mvm->mutex);
392
393 return ret ?: count;
394 }
395
396 #define BT_MBOX_MSG(_notif, _num, _field) \
397 ((le32_to_cpu((_notif)->mbox_msg[(_num)]) & BT_MBOX##_num##_##_field)\
398 >> BT_MBOX##_num##_##_field##_POS)
399
400
401 #define BT_MBOX_PRINT(_num, _field, _end) \
402 pos += scnprintf(buf + pos, bufsz - pos, \
403 "\t%s: %d%s", \
404 #_field, \
405 BT_MBOX_MSG(notif, _num, _field), \
406 true ? "\n" : ", ");
407
408 static
409 int iwl_mvm_coex_dump_mbox(struct iwl_bt_coex_profile_notif *notif, char *buf,
410 int pos, int bufsz)
411 {
412 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw0:\n");
413
414 BT_MBOX_PRINT(0, LE_SLAVE_LAT, false);
415 BT_MBOX_PRINT(0, LE_PROF1, false);
416 BT_MBOX_PRINT(0, LE_PROF2, false);
417 BT_MBOX_PRINT(0, LE_PROF_OTHER, false);
418 BT_MBOX_PRINT(0, CHL_SEQ_N, false);
419 BT_MBOX_PRINT(0, INBAND_S, false);
420 BT_MBOX_PRINT(0, LE_MIN_RSSI, false);
421 BT_MBOX_PRINT(0, LE_SCAN, false);
422 BT_MBOX_PRINT(0, LE_ADV, false);
423 BT_MBOX_PRINT(0, LE_MAX_TX_POWER, false);
424 BT_MBOX_PRINT(0, OPEN_CON_1, true);
425
426 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw1:\n");
427
428 BT_MBOX_PRINT(1, BR_MAX_TX_POWER, false);
429 BT_MBOX_PRINT(1, IP_SR, false);
430 BT_MBOX_PRINT(1, LE_MSTR, false);
431 BT_MBOX_PRINT(1, AGGR_TRFC_LD, false);
432 BT_MBOX_PRINT(1, MSG_TYPE, false);
433 BT_MBOX_PRINT(1, SSN, true);
434
435 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw2:\n");
436
437 BT_MBOX_PRINT(2, SNIFF_ACT, false);
438 BT_MBOX_PRINT(2, PAG, false);
439 BT_MBOX_PRINT(2, INQUIRY, false);
440 BT_MBOX_PRINT(2, CONN, false);
441 BT_MBOX_PRINT(2, SNIFF_INTERVAL, false);
442 BT_MBOX_PRINT(2, DISC, false);
443 BT_MBOX_PRINT(2, SCO_TX_ACT, false);
444 BT_MBOX_PRINT(2, SCO_RX_ACT, false);
445 BT_MBOX_PRINT(2, ESCO_RE_TX, false);
446 BT_MBOX_PRINT(2, SCO_DURATION, true);
447
448 pos += scnprintf(buf+pos, bufsz-pos, "MBOX dw3:\n");
449
450 BT_MBOX_PRINT(3, SCO_STATE, false);
451 BT_MBOX_PRINT(3, SNIFF_STATE, false);
452 BT_MBOX_PRINT(3, A2DP_STATE, false);
453 BT_MBOX_PRINT(3, ACL_STATE, false);
454 BT_MBOX_PRINT(3, MSTR_STATE, false);
455 BT_MBOX_PRINT(3, OBX_STATE, false);
456 BT_MBOX_PRINT(3, OPEN_CON_2, false);
457 BT_MBOX_PRINT(3, TRAFFIC_LOAD, false);
458 BT_MBOX_PRINT(3, CHL_SEQN_LSB, false);
459 BT_MBOX_PRINT(3, INBAND_P, false);
460 BT_MBOX_PRINT(3, MSG_TYPE_2, false);
461 BT_MBOX_PRINT(3, SSN_2, false);
462 BT_MBOX_PRINT(3, UPDATE_REQUEST, true);
463
464 return pos;
465 }
466
467 static ssize_t iwl_dbgfs_bt_notif_read(struct file *file, char __user *user_buf,
468 size_t count, loff_t *ppos)
469 {
470 struct iwl_mvm *mvm = file->private_data;
471 struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;
472 char *buf;
473 int ret, pos = 0, bufsz = sizeof(char) * 1024;
474
475 buf = kmalloc(bufsz, GFP_KERNEL);
476 if (!buf)
477 return -ENOMEM;
478
479 mutex_lock(&mvm->mutex);
480
481 pos += iwl_mvm_coex_dump_mbox(notif, buf, pos, bufsz);
482
483 pos += scnprintf(buf + pos, bufsz - pos, "bt_ci_compliance = %d\n",
484 notif->bt_ci_compliance);
485 pos += scnprintf(buf + pos, bufsz - pos, "primary_ch_lut = %d\n",
486 le32_to_cpu(notif->primary_ch_lut));
487 pos += scnprintf(buf + pos, bufsz - pos, "secondary_ch_lut = %d\n",
488 le32_to_cpu(notif->secondary_ch_lut));
489 pos += scnprintf(buf + pos,
490 bufsz - pos, "bt_activity_grading = %d\n",
491 le32_to_cpu(notif->bt_activity_grading));
492 pos += scnprintf(buf + pos, bufsz - pos,
493 "antenna isolation = %d CORUN LUT index = %d\n",
494 mvm->last_ant_isol, mvm->last_corun_lut);
495 pos += scnprintf(buf + pos, bufsz - pos, "bt_rrc = %d\n",
496 (notif->ttc_rrc_status >> 4) & 0xF);
497 pos += scnprintf(buf + pos, bufsz - pos, "bt_ttc = %d\n",
498 notif->ttc_rrc_status & 0xF);
499
500 pos += scnprintf(buf + pos, bufsz - pos, "sync_sco = %d\n",
501 IWL_MVM_BT_COEX_SYNC2SCO);
502 pos += scnprintf(buf + pos, bufsz - pos, "mplut = %d\n",
503 IWL_MVM_BT_COEX_MPLUT);
504 pos += scnprintf(buf + pos, bufsz - pos, "corunning = %d\n",
505 IWL_MVM_BT_COEX_CORUNNING);
506
507 mutex_unlock(&mvm->mutex);
508
509 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
510 kfree(buf);
511
512 return ret;
513 }
514 #undef BT_MBOX_PRINT
515
516 static ssize_t iwl_dbgfs_bt_cmd_read(struct file *file, char __user *user_buf,
517 size_t count, loff_t *ppos)
518 {
519 struct iwl_mvm *mvm = file->private_data;
520 struct iwl_bt_coex_ci_cmd *cmd = &mvm->last_bt_ci_cmd;
521 char buf[256];
522 int bufsz = sizeof(buf);
523 int pos = 0;
524
525 mutex_lock(&mvm->mutex);
526
527 pos += scnprintf(buf + pos, bufsz - pos, "Channel inhibition CMD\n");
528 pos += scnprintf(buf + pos, bufsz - pos,
529 "\tPrimary Channel Bitmap 0x%016llx\n",
530 le64_to_cpu(cmd->bt_primary_ci));
531 pos += scnprintf(buf + pos, bufsz - pos,
532 "\tSecondary Channel Bitmap 0x%016llx\n",
533 le64_to_cpu(cmd->bt_secondary_ci));
534
535 mutex_unlock(&mvm->mutex);
536
537 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
538 }
539
540 static ssize_t
541 iwl_dbgfs_bt_tx_prio_write(struct iwl_mvm *mvm, char *buf,
542 size_t count, loff_t *ppos)
543 {
544 u32 bt_tx_prio;
545
546 if (sscanf(buf, "%u", &bt_tx_prio) != 1)
547 return -EINVAL;
548 if (bt_tx_prio > 4)
549 return -EINVAL;
550
551 mvm->bt_tx_prio = bt_tx_prio;
552
553 return count;
554 }
555
556 static ssize_t
557 iwl_dbgfs_bt_force_ant_write(struct iwl_mvm *mvm, char *buf,
558 size_t count, loff_t *ppos)
559 {
560 static const char * const modes_str[BT_FORCE_ANT_MAX] = {
561 [BT_FORCE_ANT_DIS] = "dis",
562 [BT_FORCE_ANT_AUTO] = "auto",
563 [BT_FORCE_ANT_BT] = "bt",
564 [BT_FORCE_ANT_WIFI] = "wifi",
565 };
566 int ret, bt_force_ant_mode;
567
568 for (bt_force_ant_mode = 0;
569 bt_force_ant_mode < ARRAY_SIZE(modes_str);
570 bt_force_ant_mode++) {
571 if (!strcmp(buf, modes_str[bt_force_ant_mode]))
572 break;
573 }
574
575 if (bt_force_ant_mode >= ARRAY_SIZE(modes_str))
576 return -EINVAL;
577
578 ret = 0;
579 mutex_lock(&mvm->mutex);
580 if (mvm->bt_force_ant_mode == bt_force_ant_mode)
581 goto out;
582
583 mvm->bt_force_ant_mode = bt_force_ant_mode;
584 IWL_DEBUG_COEX(mvm, "Force mode: %s\n",
585 modes_str[mvm->bt_force_ant_mode]);
586 ret = iwl_send_bt_init_conf(mvm);
587
588 out:
589 mutex_unlock(&mvm->mutex);
590 return ret ?: count;
591 }
592
593 #define PRINT_STATS_LE32(_struct, _memb) \
594 pos += scnprintf(buf + pos, bufsz - pos, \
595 fmt_table, #_memb, \
596 le32_to_cpu(_struct->_memb))
597
598 static ssize_t iwl_dbgfs_fw_rx_stats_read(struct file *file,
599 char __user *user_buf, size_t count,
600 loff_t *ppos)
601 {
602 struct iwl_mvm *mvm = file->private_data;
603 static const char *fmt_table = "\t%-30s %10u\n";
604 static const char *fmt_header = "%-32s\n";
605 int pos = 0;
606 char *buf;
607 int ret;
608 /* 43 is the size of each data line, 33 is the size of each header */
609 size_t bufsz =
610 ((sizeof(struct mvm_statistics_rx) / sizeof(__le32)) * 43) +
611 (4 * 33) + 1;
612
613 struct mvm_statistics_rx_phy *ofdm;
614 struct mvm_statistics_rx_phy *cck;
615 struct mvm_statistics_rx_non_phy *general;
616 struct mvm_statistics_rx_ht_phy *ht;
617
618 buf = kzalloc(bufsz, GFP_KERNEL);
619 if (!buf)
620 return -ENOMEM;
621
622 mutex_lock(&mvm->mutex);
623
624 ofdm = &mvm->rx_stats.ofdm;
625 cck = &mvm->rx_stats.cck;
626 general = &mvm->rx_stats.general;
627 ht = &mvm->rx_stats.ofdm_ht;
628
629 pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
630 "Statistics_Rx - OFDM");
631 PRINT_STATS_LE32(ofdm, ina_cnt);
632 PRINT_STATS_LE32(ofdm, fina_cnt);
633 PRINT_STATS_LE32(ofdm, plcp_err);
634 PRINT_STATS_LE32(ofdm, crc32_err);
635 PRINT_STATS_LE32(ofdm, overrun_err);
636 PRINT_STATS_LE32(ofdm, early_overrun_err);
637 PRINT_STATS_LE32(ofdm, crc32_good);
638 PRINT_STATS_LE32(ofdm, false_alarm_cnt);
639 PRINT_STATS_LE32(ofdm, fina_sync_err_cnt);
640 PRINT_STATS_LE32(ofdm, sfd_timeout);
641 PRINT_STATS_LE32(ofdm, fina_timeout);
642 PRINT_STATS_LE32(ofdm, unresponded_rts);
643 PRINT_STATS_LE32(ofdm, rxe_frame_lmt_overrun);
644 PRINT_STATS_LE32(ofdm, sent_ack_cnt);
645 PRINT_STATS_LE32(ofdm, sent_cts_cnt);
646 PRINT_STATS_LE32(ofdm, sent_ba_rsp_cnt);
647 PRINT_STATS_LE32(ofdm, dsp_self_kill);
648 PRINT_STATS_LE32(ofdm, mh_format_err);
649 PRINT_STATS_LE32(ofdm, re_acq_main_rssi_sum);
650 PRINT_STATS_LE32(ofdm, reserved);
651
652 pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
653 "Statistics_Rx - CCK");
654 PRINT_STATS_LE32(cck, ina_cnt);
655 PRINT_STATS_LE32(cck, fina_cnt);
656 PRINT_STATS_LE32(cck, plcp_err);
657 PRINT_STATS_LE32(cck, crc32_err);
658 PRINT_STATS_LE32(cck, overrun_err);
659 PRINT_STATS_LE32(cck, early_overrun_err);
660 PRINT_STATS_LE32(cck, crc32_good);
661 PRINT_STATS_LE32(cck, false_alarm_cnt);
662 PRINT_STATS_LE32(cck, fina_sync_err_cnt);
663 PRINT_STATS_LE32(cck, sfd_timeout);
664 PRINT_STATS_LE32(cck, fina_timeout);
665 PRINT_STATS_LE32(cck, unresponded_rts);
666 PRINT_STATS_LE32(cck, rxe_frame_lmt_overrun);
667 PRINT_STATS_LE32(cck, sent_ack_cnt);
668 PRINT_STATS_LE32(cck, sent_cts_cnt);
669 PRINT_STATS_LE32(cck, sent_ba_rsp_cnt);
670 PRINT_STATS_LE32(cck, dsp_self_kill);
671 PRINT_STATS_LE32(cck, mh_format_err);
672 PRINT_STATS_LE32(cck, re_acq_main_rssi_sum);
673 PRINT_STATS_LE32(cck, reserved);
674
675 pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
676 "Statistics_Rx - GENERAL");
677 PRINT_STATS_LE32(general, bogus_cts);
678 PRINT_STATS_LE32(general, bogus_ack);
679 PRINT_STATS_LE32(general, non_bssid_frames);
680 PRINT_STATS_LE32(general, filtered_frames);
681 PRINT_STATS_LE32(general, non_channel_beacons);
682 PRINT_STATS_LE32(general, channel_beacons);
683 PRINT_STATS_LE32(general, num_missed_bcon);
684 PRINT_STATS_LE32(general, adc_rx_saturation_time);
685 PRINT_STATS_LE32(general, ina_detection_search_time);
686 PRINT_STATS_LE32(general, beacon_silence_rssi_a);
687 PRINT_STATS_LE32(general, beacon_silence_rssi_b);
688 PRINT_STATS_LE32(general, beacon_silence_rssi_c);
689 PRINT_STATS_LE32(general, interference_data_flag);
690 PRINT_STATS_LE32(general, channel_load);
691 PRINT_STATS_LE32(general, dsp_false_alarms);
692 PRINT_STATS_LE32(general, beacon_rssi_a);
693 PRINT_STATS_LE32(general, beacon_rssi_b);
694 PRINT_STATS_LE32(general, beacon_rssi_c);
695 PRINT_STATS_LE32(general, beacon_energy_a);
696 PRINT_STATS_LE32(general, beacon_energy_b);
697 PRINT_STATS_LE32(general, beacon_energy_c);
698 PRINT_STATS_LE32(general, num_bt_kills);
699 PRINT_STATS_LE32(general, mac_id);
700 PRINT_STATS_LE32(general, directed_data_mpdu);
701
702 pos += scnprintf(buf + pos, bufsz - pos, fmt_header,
703 "Statistics_Rx - HT");
704 PRINT_STATS_LE32(ht, plcp_err);
705 PRINT_STATS_LE32(ht, overrun_err);
706 PRINT_STATS_LE32(ht, early_overrun_err);
707 PRINT_STATS_LE32(ht, crc32_good);
708 PRINT_STATS_LE32(ht, crc32_err);
709 PRINT_STATS_LE32(ht, mh_format_err);
710 PRINT_STATS_LE32(ht, agg_crc32_good);
711 PRINT_STATS_LE32(ht, agg_mpdu_cnt);
712 PRINT_STATS_LE32(ht, agg_cnt);
713 PRINT_STATS_LE32(ht, unsupport_mcs);
714
715 mutex_unlock(&mvm->mutex);
716
717 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
718 kfree(buf);
719
720 return ret;
721 }
722 #undef PRINT_STAT_LE32
723
724 static ssize_t iwl_dbgfs_frame_stats_read(struct iwl_mvm *mvm,
725 char __user *user_buf, size_t count,
726 loff_t *ppos,
727 struct iwl_mvm_frame_stats *stats)
728 {
729 char *buff, *pos, *endpos;
730 int idx, i;
731 int ret;
732 static const size_t bufsz = 1024;
733
734 buff = kmalloc(bufsz, GFP_KERNEL);
735 if (!buff)
736 return -ENOMEM;
737
738 spin_lock_bh(&mvm->drv_stats_lock);
739
740 pos = buff;
741 endpos = pos + bufsz;
742
743 pos += scnprintf(pos, endpos - pos,
744 "Legacy/HT/VHT\t:\t%d/%d/%d\n",
745 stats->legacy_frames,
746 stats->ht_frames,
747 stats->vht_frames);
748 pos += scnprintf(pos, endpos - pos, "20/40/80\t:\t%d/%d/%d\n",
749 stats->bw_20_frames,
750 stats->bw_40_frames,
751 stats->bw_80_frames);
752 pos += scnprintf(pos, endpos - pos, "NGI/SGI\t\t:\t%d/%d\n",
753 stats->ngi_frames,
754 stats->sgi_frames);
755 pos += scnprintf(pos, endpos - pos, "SISO/MIMO2\t:\t%d/%d\n",
756 stats->siso_frames,
757 stats->mimo2_frames);
758 pos += scnprintf(pos, endpos - pos, "FAIL/SCSS\t:\t%d/%d\n",
759 stats->fail_frames,
760 stats->success_frames);
761 pos += scnprintf(pos, endpos - pos, "MPDUs agg\t:\t%d\n",
762 stats->agg_frames);
763 pos += scnprintf(pos, endpos - pos, "A-MPDUs\t\t:\t%d\n",
764 stats->ampdu_count);
765 pos += scnprintf(pos, endpos - pos, "Avg MPDUs/A-MPDU:\t%d\n",
766 stats->ampdu_count > 0 ?
767 (stats->agg_frames / stats->ampdu_count) : 0);
768
769 pos += scnprintf(pos, endpos - pos, "Last Rates\n");
770
771 idx = stats->last_frame_idx - 1;
772 for (i = 0; i < ARRAY_SIZE(stats->last_rates); i++) {
773 idx = (idx + 1) % ARRAY_SIZE(stats->last_rates);
774 if (stats->last_rates[idx] == 0)
775 continue;
776 pos += scnprintf(pos, endpos - pos, "Rate[%d]: ",
777 (int)(ARRAY_SIZE(stats->last_rates) - i));
778 pos += rs_pretty_print_rate(pos, stats->last_rates[idx]);
779 }
780 spin_unlock_bh(&mvm->drv_stats_lock);
781
782 ret = simple_read_from_buffer(user_buf, count, ppos, buff, pos - buff);
783 kfree(buff);
784
785 return ret;
786 }
787
788 static ssize_t iwl_dbgfs_drv_rx_stats_read(struct file *file,
789 char __user *user_buf, size_t count,
790 loff_t *ppos)
791 {
792 struct iwl_mvm *mvm = file->private_data;
793
794 return iwl_dbgfs_frame_stats_read(mvm, user_buf, count, ppos,
795 &mvm->drv_rx_stats);
796 }
797
798 static ssize_t iwl_dbgfs_fw_restart_write(struct iwl_mvm *mvm, char *buf,
799 size_t count, loff_t *ppos)
800 {
801 int ret;
802
803 mutex_lock(&mvm->mutex);
804
805 /* allow one more restart that we're provoking here */
806 if (mvm->restart_fw >= 0)
807 mvm->restart_fw++;
808
809 /* take the return value to make compiler happy - it will fail anyway */
810 ret = iwl_mvm_send_cmd_pdu(mvm, REPLY_ERROR, 0, 0, NULL);
811
812 mutex_unlock(&mvm->mutex);
813
814 return count;
815 }
816
817 static ssize_t iwl_dbgfs_fw_nmi_write(struct iwl_mvm *mvm, char *buf,
818 size_t count, loff_t *ppos)
819 {
820 int ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_NMI);
821 if (ret)
822 return ret;
823
824 iwl_force_nmi(mvm->trans);
825
826 iwl_mvm_unref(mvm, IWL_MVM_REF_NMI);
827
828 return count;
829 }
830
831 static ssize_t
832 iwl_dbgfs_scan_ant_rxchain_read(struct file *file,
833 char __user *user_buf,
834 size_t count, loff_t *ppos)
835 {
836 struct iwl_mvm *mvm = file->private_data;
837 int pos = 0;
838 char buf[32];
839 const size_t bufsz = sizeof(buf);
840
841 /* print which antennas were set for the scan command by the user */
842 pos += scnprintf(buf + pos, bufsz - pos, "Antennas for scan: ");
843 if (mvm->scan_rx_ant & ANT_A)
844 pos += scnprintf(buf + pos, bufsz - pos, "A");
845 if (mvm->scan_rx_ant & ANT_B)
846 pos += scnprintf(buf + pos, bufsz - pos, "B");
847 if (mvm->scan_rx_ant & ANT_C)
848 pos += scnprintf(buf + pos, bufsz - pos, "C");
849 pos += scnprintf(buf + pos, bufsz - pos, " (%hhx)\n", mvm->scan_rx_ant);
850
851 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
852 }
853
854 static ssize_t
855 iwl_dbgfs_scan_ant_rxchain_write(struct iwl_mvm *mvm, char *buf,
856 size_t count, loff_t *ppos)
857 {
858 u8 scan_rx_ant;
859
860 if (sscanf(buf, "%hhx", &scan_rx_ant) != 1)
861 return -EINVAL;
862 if (scan_rx_ant > ANT_ABC)
863 return -EINVAL;
864 if (scan_rx_ant & ~(iwl_mvm_get_valid_rx_ant(mvm)))
865 return -EINVAL;
866
867 if (mvm->scan_rx_ant != scan_rx_ant) {
868 mvm->scan_rx_ant = scan_rx_ant;
869 if (fw_has_capa(&mvm->fw->ucode_capa,
870 IWL_UCODE_TLV_CAPA_UMAC_SCAN))
871 iwl_mvm_config_scan(mvm);
872 }
873
874 return count;
875 }
876
877 static ssize_t iwl_dbgfs_indirection_tbl_write(struct iwl_mvm *mvm,
878 char *buf, size_t count,
879 loff_t *ppos)
880 {
881 struct iwl_rss_config_cmd cmd = {
882 .flags = cpu_to_le32(IWL_RSS_ENABLE),
883 .hash_mask = IWL_RSS_HASH_TYPE_IPV4_TCP |
884 IWL_RSS_HASH_TYPE_IPV4_UDP |
885 IWL_RSS_HASH_TYPE_IPV4_PAYLOAD |
886 IWL_RSS_HASH_TYPE_IPV6_TCP |
887 IWL_RSS_HASH_TYPE_IPV6_UDP |
888 IWL_RSS_HASH_TYPE_IPV6_PAYLOAD,
889 };
890 int ret, i, num_repeats, nbytes = count / 2;
891
892 ret = hex2bin(cmd.indirection_table, buf, nbytes);
893 if (ret)
894 return ret;
895
896 /*
897 * The input is the redirection table, partial or full.
898 * Repeat the pattern if needed.
899 * For example, input of 01020F will be repeated 42 times,
900 * indirecting RSS hash results to queues 1, 2, 15 (skipping
901 * queues 3 - 14).
902 */
903 num_repeats = ARRAY_SIZE(cmd.indirection_table) / nbytes;
904 for (i = 1; i < num_repeats; i++)
905 memcpy(&cmd.indirection_table[i * nbytes],
906 cmd.indirection_table, nbytes);
907 /* handle cut in the middle pattern for the last places */
908 memcpy(&cmd.indirection_table[i * nbytes], cmd.indirection_table,
909 ARRAY_SIZE(cmd.indirection_table) % nbytes);
910
911 netdev_rss_key_fill(cmd.secret_key, sizeof(cmd.secret_key));
912
913 mutex_lock(&mvm->mutex);
914 ret = iwl_mvm_send_cmd_pdu(mvm, RSS_CONFIG_CMD, 0, sizeof(cmd), &cmd);
915 mutex_unlock(&mvm->mutex);
916
917 return ret ?: count;
918 }
919
920 static ssize_t iwl_dbgfs_fw_dbg_conf_read(struct file *file,
921 char __user *user_buf,
922 size_t count, loff_t *ppos)
923 {
924 struct iwl_mvm *mvm = file->private_data;
925 int conf;
926 char buf[8];
927 const size_t bufsz = sizeof(buf);
928 int pos = 0;
929
930 mutex_lock(&mvm->mutex);
931 conf = mvm->fw_dbg_conf;
932 mutex_unlock(&mvm->mutex);
933
934 pos += scnprintf(buf + pos, bufsz - pos, "%d\n", conf);
935
936 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
937 }
938
939 /*
940 * Enable / Disable continuous recording.
941 * Cause the FW to start continuous recording, by sending the relevant hcmd.
942 * Enable: input of every integer larger than 0, ENABLE_CONT_RECORDING.
943 * Disable: for 0 as input, DISABLE_CONT_RECORDING.
944 */
945 static ssize_t iwl_dbgfs_cont_recording_write(struct iwl_mvm *mvm,
946 char *buf, size_t count,
947 loff_t *ppos)
948 {
949 struct iwl_trans *trans = mvm->trans;
950 const struct iwl_fw_dbg_dest_tlv *dest = trans->dbg_dest_tlv;
951 struct iwl_continuous_record_cmd cont_rec = {};
952 int ret, rec_mode;
953
954 if (!dest)
955 return -EOPNOTSUPP;
956
957 if (dest->monitor_mode != SMEM_MODE ||
958 trans->cfg->device_family != IWL_DEVICE_FAMILY_8000)
959 return -EOPNOTSUPP;
960
961 ret = kstrtoint(buf, 0, &rec_mode);
962 if (ret)
963 return ret;
964
965 cont_rec.record_mode.enable_recording = rec_mode ?
966 cpu_to_le16(ENABLE_CONT_RECORDING) :
967 cpu_to_le16(DISABLE_CONT_RECORDING);
968
969 mutex_lock(&mvm->mutex);
970 ret = iwl_mvm_send_cmd_pdu(mvm, LDBG_CONFIG_CMD, 0,
971 sizeof(cont_rec), &cont_rec);
972 mutex_unlock(&mvm->mutex);
973
974 return ret ?: count;
975 }
976
977 static ssize_t iwl_dbgfs_fw_dbg_conf_write(struct iwl_mvm *mvm,
978 char *buf, size_t count,
979 loff_t *ppos)
980 {
981 unsigned int conf_id;
982 int ret;
983
984 ret = kstrtouint(buf, 0, &conf_id);
985 if (ret)
986 return ret;
987
988 if (WARN_ON(conf_id >= FW_DBG_CONF_MAX))
989 return -EINVAL;
990
991 mutex_lock(&mvm->mutex);
992 ret = iwl_mvm_start_fw_dbg_conf(mvm, conf_id);
993 mutex_unlock(&mvm->mutex);
994
995 return ret ?: count;
996 }
997
998 static ssize_t iwl_dbgfs_fw_dbg_collect_write(struct iwl_mvm *mvm,
999 char *buf, size_t count,
1000 loff_t *ppos)
1001 {
1002 int ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE);
1003
1004 if (ret)
1005 return ret;
1006
1007 iwl_mvm_fw_dbg_collect(mvm, FW_DBG_TRIGGER_USER, buf,
1008 (count - 1), NULL);
1009
1010 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE);
1011
1012 return count;
1013 }
1014
1015 static ssize_t iwl_dbgfs_max_amsdu_len_write(struct iwl_mvm *mvm,
1016 char *buf, size_t count,
1017 loff_t *ppos)
1018 {
1019 unsigned int max_amsdu_len;
1020 int ret;
1021
1022 ret = kstrtouint(buf, 0, &max_amsdu_len);
1023
1024 if (max_amsdu_len > IEEE80211_MAX_MPDU_LEN_VHT_11454)
1025 return -EINVAL;
1026 mvm->max_amsdu_len = max_amsdu_len;
1027
1028 return count;
1029 }
1030
1031 #define ADD_TEXT(...) pos += scnprintf(buf + pos, bufsz - pos, __VA_ARGS__)
1032 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1033 static ssize_t iwl_dbgfs_bcast_filters_read(struct file *file,
1034 char __user *user_buf,
1035 size_t count, loff_t *ppos)
1036 {
1037 struct iwl_mvm *mvm = file->private_data;
1038 struct iwl_bcast_filter_cmd cmd;
1039 const struct iwl_fw_bcast_filter *filter;
1040 char *buf;
1041 int bufsz = 1024;
1042 int i, j, pos = 0;
1043 ssize_t ret;
1044
1045 buf = kzalloc(bufsz, GFP_KERNEL);
1046 if (!buf)
1047 return -ENOMEM;
1048
1049 mutex_lock(&mvm->mutex);
1050 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1051 ADD_TEXT("None\n");
1052 mutex_unlock(&mvm->mutex);
1053 goto out;
1054 }
1055 mutex_unlock(&mvm->mutex);
1056
1057 for (i = 0; cmd.filters[i].attrs[0].mask; i++) {
1058 filter = &cmd.filters[i];
1059
1060 ADD_TEXT("Filter [%d]:\n", i);
1061 ADD_TEXT("\tDiscard=%d\n", filter->discard);
1062 ADD_TEXT("\tFrame Type: %s\n",
1063 filter->frame_type ? "IPv4" : "Generic");
1064
1065 for (j = 0; j < ARRAY_SIZE(filter->attrs); j++) {
1066 const struct iwl_fw_bcast_filter_attr *attr;
1067
1068 attr = &filter->attrs[j];
1069 if (!attr->mask)
1070 break;
1071
1072 ADD_TEXT("\tAttr [%d]: offset=%d (from %s), mask=0x%x, value=0x%x reserved=0x%x\n",
1073 j, attr->offset,
1074 attr->offset_type ? "IP End" :
1075 "Payload Start",
1076 be32_to_cpu(attr->mask),
1077 be32_to_cpu(attr->val),
1078 le16_to_cpu(attr->reserved1));
1079 }
1080 }
1081 out:
1082 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1083 kfree(buf);
1084 return ret;
1085 }
1086
1087 static ssize_t iwl_dbgfs_bcast_filters_write(struct iwl_mvm *mvm, char *buf,
1088 size_t count, loff_t *ppos)
1089 {
1090 int pos, next_pos;
1091 struct iwl_fw_bcast_filter filter = {};
1092 struct iwl_bcast_filter_cmd cmd;
1093 u32 filter_id, attr_id, mask, value;
1094 int err = 0;
1095
1096 if (sscanf(buf, "%d %hhi %hhi %n", &filter_id, &filter.discard,
1097 &filter.frame_type, &pos) != 3)
1098 return -EINVAL;
1099
1100 if (filter_id >= ARRAY_SIZE(mvm->dbgfs_bcast_filtering.cmd.filters) ||
1101 filter.frame_type > BCAST_FILTER_FRAME_TYPE_IPV4)
1102 return -EINVAL;
1103
1104 for (attr_id = 0; attr_id < ARRAY_SIZE(filter.attrs);
1105 attr_id++) {
1106 struct iwl_fw_bcast_filter_attr *attr =
1107 &filter.attrs[attr_id];
1108
1109 if (pos >= count)
1110 break;
1111
1112 if (sscanf(&buf[pos], "%hhi %hhi %i %i %n",
1113 &attr->offset, &attr->offset_type,
1114 &mask, &value, &next_pos) != 4)
1115 return -EINVAL;
1116
1117 attr->mask = cpu_to_be32(mask);
1118 attr->val = cpu_to_be32(value);
1119 if (mask)
1120 filter.num_attrs++;
1121
1122 pos += next_pos;
1123 }
1124
1125 mutex_lock(&mvm->mutex);
1126 memcpy(&mvm->dbgfs_bcast_filtering.cmd.filters[filter_id],
1127 &filter, sizeof(filter));
1128
1129 /* send updated bcast filtering configuration */
1130 if (mvm->dbgfs_bcast_filtering.override &&
1131 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1132 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1133 sizeof(cmd), &cmd);
1134 mutex_unlock(&mvm->mutex);
1135
1136 return err ?: count;
1137 }
1138
1139 static ssize_t iwl_dbgfs_bcast_filters_macs_read(struct file *file,
1140 char __user *user_buf,
1141 size_t count, loff_t *ppos)
1142 {
1143 struct iwl_mvm *mvm = file->private_data;
1144 struct iwl_bcast_filter_cmd cmd;
1145 char *buf;
1146 int bufsz = 1024;
1147 int i, pos = 0;
1148 ssize_t ret;
1149
1150 buf = kzalloc(bufsz, GFP_KERNEL);
1151 if (!buf)
1152 return -ENOMEM;
1153
1154 mutex_lock(&mvm->mutex);
1155 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1156 ADD_TEXT("None\n");
1157 mutex_unlock(&mvm->mutex);
1158 goto out;
1159 }
1160 mutex_unlock(&mvm->mutex);
1161
1162 for (i = 0; i < ARRAY_SIZE(cmd.macs); i++) {
1163 const struct iwl_fw_bcast_mac *mac = &cmd.macs[i];
1164
1165 ADD_TEXT("Mac [%d]: discard=%d attached_filters=0x%x\n",
1166 i, mac->default_discard, mac->attached_filters);
1167 }
1168 out:
1169 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1170 kfree(buf);
1171 return ret;
1172 }
1173
1174 static ssize_t iwl_dbgfs_bcast_filters_macs_write(struct iwl_mvm *mvm,
1175 char *buf, size_t count,
1176 loff_t *ppos)
1177 {
1178 struct iwl_bcast_filter_cmd cmd;
1179 struct iwl_fw_bcast_mac mac = {};
1180 u32 mac_id, attached_filters;
1181 int err = 0;
1182
1183 if (!mvm->bcast_filters)
1184 return -ENOENT;
1185
1186 if (sscanf(buf, "%d %hhi %i", &mac_id, &mac.default_discard,
1187 &attached_filters) != 3)
1188 return -EINVAL;
1189
1190 if (mac_id >= ARRAY_SIZE(cmd.macs) ||
1191 mac.default_discard > 1 ||
1192 attached_filters >= BIT(ARRAY_SIZE(cmd.filters)))
1193 return -EINVAL;
1194
1195 mac.attached_filters = cpu_to_le16(attached_filters);
1196
1197 mutex_lock(&mvm->mutex);
1198 memcpy(&mvm->dbgfs_bcast_filtering.cmd.macs[mac_id],
1199 &mac, sizeof(mac));
1200
1201 /* send updated bcast filtering configuration */
1202 if (mvm->dbgfs_bcast_filtering.override &&
1203 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1204 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1205 sizeof(cmd), &cmd);
1206 mutex_unlock(&mvm->mutex);
1207
1208 return err ?: count;
1209 }
1210 #endif
1211
1212 #ifdef CONFIG_PM_SLEEP
1213 static ssize_t iwl_dbgfs_d3_sram_write(struct iwl_mvm *mvm, char *buf,
1214 size_t count, loff_t *ppos)
1215 {
1216 int store;
1217
1218 if (sscanf(buf, "%d", &store) != 1)
1219 return -EINVAL;
1220
1221 mvm->store_d3_resume_sram = store;
1222
1223 return count;
1224 }
1225
1226 static ssize_t iwl_dbgfs_d3_sram_read(struct file *file, char __user *user_buf,
1227 size_t count, loff_t *ppos)
1228 {
1229 struct iwl_mvm *mvm = file->private_data;
1230 const struct fw_img *img;
1231 int ofs, len, pos = 0;
1232 size_t bufsz, ret;
1233 char *buf;
1234 u8 *ptr = mvm->d3_resume_sram;
1235
1236 img = &mvm->fw->img[IWL_UCODE_WOWLAN];
1237 len = img->sec[IWL_UCODE_SECTION_DATA].len;
1238
1239 bufsz = len * 4 + 256;
1240 buf = kzalloc(bufsz, GFP_KERNEL);
1241 if (!buf)
1242 return -ENOMEM;
1243
1244 pos += scnprintf(buf, bufsz, "D3 SRAM capture: %sabled\n",
1245 mvm->store_d3_resume_sram ? "en" : "dis");
1246
1247 if (ptr) {
1248 for (ofs = 0; ofs < len; ofs += 16) {
1249 pos += scnprintf(buf + pos, bufsz - pos,
1250 "0x%.4x %16ph\n", ofs, ptr + ofs);
1251 }
1252 } else {
1253 pos += scnprintf(buf + pos, bufsz - pos,
1254 "(no data captured)\n");
1255 }
1256
1257 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1258
1259 kfree(buf);
1260
1261 return ret;
1262 }
1263 #endif
1264
1265 #define PRINT_MVM_REF(ref) do { \
1266 if (mvm->refs[ref]) \
1267 pos += scnprintf(buf + pos, bufsz - pos, \
1268 "\t(0x%lx): %d %s\n", \
1269 BIT(ref), mvm->refs[ref], #ref); \
1270 } while (0)
1271
1272 static ssize_t iwl_dbgfs_d0i3_refs_read(struct file *file,
1273 char __user *user_buf,
1274 size_t count, loff_t *ppos)
1275 {
1276 struct iwl_mvm *mvm = file->private_data;
1277 int i, pos = 0;
1278 char buf[256];
1279 const size_t bufsz = sizeof(buf);
1280 u32 refs = 0;
1281
1282 for (i = 0; i < IWL_MVM_REF_COUNT; i++)
1283 if (mvm->refs[i])
1284 refs |= BIT(i);
1285
1286 pos += scnprintf(buf + pos, bufsz - pos, "taken mvm refs: 0x%x\n",
1287 refs);
1288
1289 PRINT_MVM_REF(IWL_MVM_REF_UCODE_DOWN);
1290 PRINT_MVM_REF(IWL_MVM_REF_SCAN);
1291 PRINT_MVM_REF(IWL_MVM_REF_ROC);
1292 PRINT_MVM_REF(IWL_MVM_REF_ROC_AUX);
1293 PRINT_MVM_REF(IWL_MVM_REF_P2P_CLIENT);
1294 PRINT_MVM_REF(IWL_MVM_REF_AP_IBSS);
1295 PRINT_MVM_REF(IWL_MVM_REF_USER);
1296 PRINT_MVM_REF(IWL_MVM_REF_TX);
1297 PRINT_MVM_REF(IWL_MVM_REF_TX_AGG);
1298 PRINT_MVM_REF(IWL_MVM_REF_ADD_IF);
1299 PRINT_MVM_REF(IWL_MVM_REF_START_AP);
1300 PRINT_MVM_REF(IWL_MVM_REF_BSS_CHANGED);
1301 PRINT_MVM_REF(IWL_MVM_REF_PREPARE_TX);
1302 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_TDLS);
1303 PRINT_MVM_REF(IWL_MVM_REF_CHECK_CTKILL);
1304 PRINT_MVM_REF(IWL_MVM_REF_PRPH_READ);
1305 PRINT_MVM_REF(IWL_MVM_REF_PRPH_WRITE);
1306 PRINT_MVM_REF(IWL_MVM_REF_NMI);
1307 PRINT_MVM_REF(IWL_MVM_REF_TM_CMD);
1308 PRINT_MVM_REF(IWL_MVM_REF_EXIT_WORK);
1309 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_CSA);
1310 PRINT_MVM_REF(IWL_MVM_REF_FW_DBG_COLLECT);
1311 PRINT_MVM_REF(IWL_MVM_REF_INIT_UCODE);
1312 PRINT_MVM_REF(IWL_MVM_REF_SENDING_CMD);
1313 PRINT_MVM_REF(IWL_MVM_REF_RX);
1314
1315 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1316 }
1317
1318 static ssize_t iwl_dbgfs_d0i3_refs_write(struct iwl_mvm *mvm, char *buf,
1319 size_t count, loff_t *ppos)
1320 {
1321 unsigned long value;
1322 int ret;
1323 bool taken;
1324
1325 ret = kstrtoul(buf, 10, &value);
1326 if (ret < 0)
1327 return ret;
1328
1329 mutex_lock(&mvm->mutex);
1330
1331 taken = mvm->refs[IWL_MVM_REF_USER];
1332 if (value == 1 && !taken)
1333 iwl_mvm_ref(mvm, IWL_MVM_REF_USER);
1334 else if (value == 0 && taken)
1335 iwl_mvm_unref(mvm, IWL_MVM_REF_USER);
1336 else
1337 ret = -EINVAL;
1338
1339 mutex_unlock(&mvm->mutex);
1340
1341 if (ret < 0)
1342 return ret;
1343 return count;
1344 }
1345
1346 #define MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
1347 _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1348 #define MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
1349 _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1350 #define MVM_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do { \
1351 if (!debugfs_create_file(alias, mode, parent, mvm, \
1352 &iwl_dbgfs_##name##_ops)) \
1353 goto err; \
1354 } while (0)
1355 #define MVM_DEBUGFS_ADD_FILE(name, parent, mode) \
1356 MVM_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
1357
1358 static ssize_t
1359 iwl_dbgfs_prph_reg_read(struct file *file,
1360 char __user *user_buf,
1361 size_t count, loff_t *ppos)
1362 {
1363 struct iwl_mvm *mvm = file->private_data;
1364 int pos = 0;
1365 char buf[32];
1366 const size_t bufsz = sizeof(buf);
1367 int ret;
1368
1369 if (!mvm->dbgfs_prph_reg_addr)
1370 return -EINVAL;
1371
1372 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_READ);
1373 if (ret)
1374 return ret;
1375
1376 pos += scnprintf(buf + pos, bufsz - pos, "Reg 0x%x: (0x%x)\n",
1377 mvm->dbgfs_prph_reg_addr,
1378 iwl_read_prph(mvm->trans, mvm->dbgfs_prph_reg_addr));
1379
1380 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_READ);
1381
1382 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1383 }
1384
1385 static ssize_t
1386 iwl_dbgfs_prph_reg_write(struct iwl_mvm *mvm, char *buf,
1387 size_t count, loff_t *ppos)
1388 {
1389 u8 args;
1390 u32 value;
1391 int ret;
1392
1393 args = sscanf(buf, "%i %i", &mvm->dbgfs_prph_reg_addr, &value);
1394 /* if we only want to set the reg address - nothing more to do */
1395 if (args == 1)
1396 goto out;
1397
1398 /* otherwise, make sure we have both address and value */
1399 if (args != 2)
1400 return -EINVAL;
1401
1402 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE);
1403 if (ret)
1404 return ret;
1405
1406 iwl_write_prph(mvm->trans, mvm->dbgfs_prph_reg_addr, value);
1407
1408 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE);
1409 out:
1410 return count;
1411 }
1412
1413 static ssize_t
1414 iwl_dbgfs_send_echo_cmd_write(struct iwl_mvm *mvm, char *buf,
1415 size_t count, loff_t *ppos)
1416 {
1417 int ret;
1418
1419 mutex_lock(&mvm->mutex);
1420 ret = iwl_mvm_send_cmd_pdu(mvm, ECHO_CMD, 0, 0, NULL);
1421 mutex_unlock(&mvm->mutex);
1422
1423 return ret ?: count;
1424 }
1425
1426 MVM_DEBUGFS_READ_WRITE_FILE_OPS(prph_reg, 64);
1427
1428 /* Device wide debugfs entries */
1429 MVM_DEBUGFS_READ_FILE_OPS(ctdp_budget);
1430 MVM_DEBUGFS_WRITE_FILE_OPS(stop_ctdp, 8);
1431 MVM_DEBUGFS_WRITE_FILE_OPS(tx_flush, 16);
1432 MVM_DEBUGFS_WRITE_FILE_OPS(sta_drain, 8);
1433 MVM_DEBUGFS_WRITE_FILE_OPS(send_echo_cmd, 8);
1434 MVM_DEBUGFS_READ_WRITE_FILE_OPS(sram, 64);
1435 MVM_DEBUGFS_READ_WRITE_FILE_OPS(set_nic_temperature, 64);
1436 MVM_DEBUGFS_READ_FILE_OPS(nic_temp);
1437 MVM_DEBUGFS_READ_FILE_OPS(stations);
1438 MVM_DEBUGFS_READ_FILE_OPS(bt_notif);
1439 MVM_DEBUGFS_READ_FILE_OPS(bt_cmd);
1440 MVM_DEBUGFS_READ_WRITE_FILE_OPS(disable_power_off, 64);
1441 MVM_DEBUGFS_READ_FILE_OPS(fw_rx_stats);
1442 MVM_DEBUGFS_READ_FILE_OPS(drv_rx_stats);
1443 MVM_DEBUGFS_WRITE_FILE_OPS(fw_restart, 10);
1444 MVM_DEBUGFS_WRITE_FILE_OPS(fw_nmi, 10);
1445 MVM_DEBUGFS_WRITE_FILE_OPS(bt_tx_prio, 10);
1446 MVM_DEBUGFS_WRITE_FILE_OPS(bt_force_ant, 10);
1447 MVM_DEBUGFS_READ_WRITE_FILE_OPS(scan_ant_rxchain, 8);
1448 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d0i3_refs, 8);
1449 MVM_DEBUGFS_READ_WRITE_FILE_OPS(fw_dbg_conf, 8);
1450 MVM_DEBUGFS_WRITE_FILE_OPS(fw_dbg_collect, 64);
1451 MVM_DEBUGFS_WRITE_FILE_OPS(cont_recording, 8);
1452 MVM_DEBUGFS_WRITE_FILE_OPS(max_amsdu_len, 8);
1453 MVM_DEBUGFS_WRITE_FILE_OPS(indirection_tbl,
1454 (IWL_RSS_INDIRECTION_TABLE_SIZE * 2));
1455
1456 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1457 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters, 256);
1458 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters_macs, 256);
1459 #endif
1460
1461 #ifdef CONFIG_PM_SLEEP
1462 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d3_sram, 8);
1463 #endif
1464
1465 int iwl_mvm_dbgfs_register(struct iwl_mvm *mvm, struct dentry *dbgfs_dir)
1466 {
1467 struct dentry *bcast_dir __maybe_unused;
1468 char buf[100];
1469
1470 spin_lock_init(&mvm->drv_stats_lock);
1471
1472 mvm->debugfs_dir = dbgfs_dir;
1473
1474 MVM_DEBUGFS_ADD_FILE(tx_flush, mvm->debugfs_dir, S_IWUSR);
1475 MVM_DEBUGFS_ADD_FILE(sta_drain, mvm->debugfs_dir, S_IWUSR);
1476 MVM_DEBUGFS_ADD_FILE(sram, mvm->debugfs_dir, S_IWUSR | S_IRUSR);
1477 MVM_DEBUGFS_ADD_FILE(set_nic_temperature, mvm->debugfs_dir,
1478 S_IWUSR | S_IRUSR);
1479 MVM_DEBUGFS_ADD_FILE(nic_temp, dbgfs_dir, S_IRUSR);
1480 MVM_DEBUGFS_ADD_FILE(ctdp_budget, dbgfs_dir, S_IRUSR);
1481 MVM_DEBUGFS_ADD_FILE(stop_ctdp, dbgfs_dir, S_IWUSR);
1482 MVM_DEBUGFS_ADD_FILE(stations, dbgfs_dir, S_IRUSR);
1483 MVM_DEBUGFS_ADD_FILE(bt_notif, dbgfs_dir, S_IRUSR);
1484 MVM_DEBUGFS_ADD_FILE(bt_cmd, dbgfs_dir, S_IRUSR);
1485 MVM_DEBUGFS_ADD_FILE(disable_power_off, mvm->debugfs_dir,
1486 S_IRUSR | S_IWUSR);
1487 MVM_DEBUGFS_ADD_FILE(fw_rx_stats, mvm->debugfs_dir, S_IRUSR);
1488 MVM_DEBUGFS_ADD_FILE(drv_rx_stats, mvm->debugfs_dir, S_IRUSR);
1489 MVM_DEBUGFS_ADD_FILE(fw_restart, mvm->debugfs_dir, S_IWUSR);
1490 MVM_DEBUGFS_ADD_FILE(fw_nmi, mvm->debugfs_dir, S_IWUSR);
1491 MVM_DEBUGFS_ADD_FILE(bt_tx_prio, mvm->debugfs_dir, S_IWUSR);
1492 MVM_DEBUGFS_ADD_FILE(bt_force_ant, mvm->debugfs_dir, S_IWUSR);
1493 MVM_DEBUGFS_ADD_FILE(scan_ant_rxchain, mvm->debugfs_dir,
1494 S_IWUSR | S_IRUSR);
1495 MVM_DEBUGFS_ADD_FILE(prph_reg, mvm->debugfs_dir, S_IWUSR | S_IRUSR);
1496 MVM_DEBUGFS_ADD_FILE(d0i3_refs, mvm->debugfs_dir, S_IRUSR | S_IWUSR);
1497 MVM_DEBUGFS_ADD_FILE(fw_dbg_conf, mvm->debugfs_dir, S_IRUSR | S_IWUSR);
1498 MVM_DEBUGFS_ADD_FILE(fw_dbg_collect, mvm->debugfs_dir, S_IWUSR);
1499 MVM_DEBUGFS_ADD_FILE(max_amsdu_len, mvm->debugfs_dir, S_IWUSR);
1500 MVM_DEBUGFS_ADD_FILE(send_echo_cmd, mvm->debugfs_dir, S_IWUSR);
1501 MVM_DEBUGFS_ADD_FILE(cont_recording, mvm->debugfs_dir, S_IWUSR);
1502 MVM_DEBUGFS_ADD_FILE(indirection_tbl, mvm->debugfs_dir, S_IWUSR);
1503 if (!debugfs_create_bool("enable_scan_iteration_notif",
1504 S_IRUSR | S_IWUSR,
1505 mvm->debugfs_dir,
1506 &mvm->scan_iter_notif_enabled))
1507 goto err;
1508 if (!debugfs_create_bool("drop_bcn_ap_mode", S_IRUSR | S_IWUSR,
1509 mvm->debugfs_dir, &mvm->drop_bcn_ap_mode))
1510 goto err;
1511
1512 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1513 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING) {
1514 bcast_dir = debugfs_create_dir("bcast_filtering",
1515 mvm->debugfs_dir);
1516 if (!bcast_dir)
1517 goto err;
1518
1519 if (!debugfs_create_bool("override", S_IRUSR | S_IWUSR,
1520 bcast_dir,
1521 &mvm->dbgfs_bcast_filtering.override))
1522 goto err;
1523
1524 MVM_DEBUGFS_ADD_FILE_ALIAS("filters", bcast_filters,
1525 bcast_dir, S_IWUSR | S_IRUSR);
1526 MVM_DEBUGFS_ADD_FILE_ALIAS("macs", bcast_filters_macs,
1527 bcast_dir, S_IWUSR | S_IRUSR);
1528 }
1529 #endif
1530
1531 #ifdef CONFIG_PM_SLEEP
1532 MVM_DEBUGFS_ADD_FILE(d3_sram, mvm->debugfs_dir, S_IRUSR | S_IWUSR);
1533 MVM_DEBUGFS_ADD_FILE(d3_test, mvm->debugfs_dir, S_IRUSR);
1534 if (!debugfs_create_bool("d3_wake_sysassert", S_IRUSR | S_IWUSR,
1535 mvm->debugfs_dir, &mvm->d3_wake_sysassert))
1536 goto err;
1537 if (!debugfs_create_u32("last_netdetect_scans", S_IRUSR,
1538 mvm->debugfs_dir, &mvm->last_netdetect_scans))
1539 goto err;
1540 #endif
1541
1542 if (!debugfs_create_u8("ps_disabled", S_IRUSR,
1543 mvm->debugfs_dir, &mvm->ps_disabled))
1544 goto err;
1545 if (!debugfs_create_blob("nvm_hw", S_IRUSR,
1546 mvm->debugfs_dir, &mvm->nvm_hw_blob))
1547 goto err;
1548 if (!debugfs_create_blob("nvm_sw", S_IRUSR,
1549 mvm->debugfs_dir, &mvm->nvm_sw_blob))
1550 goto err;
1551 if (!debugfs_create_blob("nvm_calib", S_IRUSR,
1552 mvm->debugfs_dir, &mvm->nvm_calib_blob))
1553 goto err;
1554 if (!debugfs_create_blob("nvm_prod", S_IRUSR,
1555 mvm->debugfs_dir, &mvm->nvm_prod_blob))
1556 goto err;
1557 if (!debugfs_create_blob("nvm_phy_sku", S_IRUSR,
1558 mvm->debugfs_dir, &mvm->nvm_phy_sku_blob))
1559 goto err;
1560
1561 /*
1562 * Create a symlink with mac80211. It will be removed when mac80211
1563 * exists (before the opmode exists which removes the target.)
1564 */
1565 snprintf(buf, 100, "../../%s/%s",
1566 dbgfs_dir->d_parent->d_parent->d_name.name,
1567 dbgfs_dir->d_parent->d_name.name);
1568 if (!debugfs_create_symlink("iwlwifi", mvm->hw->wiphy->debugfsdir, buf))
1569 goto err;
1570
1571 return 0;
1572 err:
1573 IWL_ERR(mvm, "Can't create the mvm debugfs directory\n");
1574 return -ENOMEM;
1575 }
Linux with added FPC-III support