projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge branches 'x86/amd', 'x86/vt-d', 'arm/exynos', 'arm/mediatek' and 'arm/renesas...
[deliverable/linux.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 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 if (ret)
1024 return ret;
1025
1026 if (max_amsdu_len > IEEE80211_MAX_MPDU_LEN_VHT_11454)
1027 return -EINVAL;
1028 mvm->max_amsdu_len = max_amsdu_len;
1029
1030 return count;
1031 }
1032
1033 #define ADD_TEXT(...) pos += scnprintf(buf + pos, bufsz - pos, __VA_ARGS__)
1034 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1035 static ssize_t iwl_dbgfs_bcast_filters_read(struct file *file,
1036 char __user *user_buf,
1037 size_t count, loff_t *ppos)
1038 {
1039 struct iwl_mvm *mvm = file->private_data;
1040 struct iwl_bcast_filter_cmd cmd;
1041 const struct iwl_fw_bcast_filter *filter;
1042 char *buf;
1043 int bufsz = 1024;
1044 int i, j, pos = 0;
1045 ssize_t ret;
1046
1047 buf = kzalloc(bufsz, GFP_KERNEL);
1048 if (!buf)
1049 return -ENOMEM;
1050
1051 mutex_lock(&mvm->mutex);
1052 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1053 ADD_TEXT("None\n");
1054 mutex_unlock(&mvm->mutex);
1055 goto out;
1056 }
1057 mutex_unlock(&mvm->mutex);
1058
1059 for (i = 0; cmd.filters[i].attrs[0].mask; i++) {
1060 filter = &cmd.filters[i];
1061
1062 ADD_TEXT("Filter [%d]:\n", i);
1063 ADD_TEXT("\tDiscard=%d\n", filter->discard);
1064 ADD_TEXT("\tFrame Type: %s\n",
1065 filter->frame_type ? "IPv4" : "Generic");
1066
1067 for (j = 0; j < ARRAY_SIZE(filter->attrs); j++) {
1068 const struct iwl_fw_bcast_filter_attr *attr;
1069
1070 attr = &filter->attrs[j];
1071 if (!attr->mask)
1072 break;
1073
1074 ADD_TEXT("\tAttr [%d]: offset=%d (from %s), mask=0x%x, value=0x%x reserved=0x%x\n",
1075 j, attr->offset,
1076 attr->offset_type ? "IP End" :
1077 "Payload Start",
1078 be32_to_cpu(attr->mask),
1079 be32_to_cpu(attr->val),
1080 le16_to_cpu(attr->reserved1));
1081 }
1082 }
1083 out:
1084 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1085 kfree(buf);
1086 return ret;
1087 }
1088
1089 static ssize_t iwl_dbgfs_bcast_filters_write(struct iwl_mvm *mvm, char *buf,
1090 size_t count, loff_t *ppos)
1091 {
1092 int pos, next_pos;
1093 struct iwl_fw_bcast_filter filter = {};
1094 struct iwl_bcast_filter_cmd cmd;
1095 u32 filter_id, attr_id, mask, value;
1096 int err = 0;
1097
1098 if (sscanf(buf, "%d %hhi %hhi %n", &filter_id, &filter.discard,
1099 &filter.frame_type, &pos) != 3)
1100 return -EINVAL;
1101
1102 if (filter_id >= ARRAY_SIZE(mvm->dbgfs_bcast_filtering.cmd.filters) ||
1103 filter.frame_type > BCAST_FILTER_FRAME_TYPE_IPV4)
1104 return -EINVAL;
1105
1106 for (attr_id = 0; attr_id < ARRAY_SIZE(filter.attrs);
1107 attr_id++) {
1108 struct iwl_fw_bcast_filter_attr *attr =
1109 &filter.attrs[attr_id];
1110
1111 if (pos >= count)
1112 break;
1113
1114 if (sscanf(&buf[pos], "%hhi %hhi %i %i %n",
1115 &attr->offset, &attr->offset_type,
1116 &mask, &value, &next_pos) != 4)
1117 return -EINVAL;
1118
1119 attr->mask = cpu_to_be32(mask);
1120 attr->val = cpu_to_be32(value);
1121 if (mask)
1122 filter.num_attrs++;
1123
1124 pos += next_pos;
1125 }
1126
1127 mutex_lock(&mvm->mutex);
1128 memcpy(&mvm->dbgfs_bcast_filtering.cmd.filters[filter_id],
1129 &filter, sizeof(filter));
1130
1131 /* send updated bcast filtering configuration */
1132 if (mvm->dbgfs_bcast_filtering.override &&
1133 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1134 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1135 sizeof(cmd), &cmd);
1136 mutex_unlock(&mvm->mutex);
1137
1138 return err ?: count;
1139 }
1140
1141 static ssize_t iwl_dbgfs_bcast_filters_macs_read(struct file *file,
1142 char __user *user_buf,
1143 size_t count, loff_t *ppos)
1144 {
1145 struct iwl_mvm *mvm = file->private_data;
1146 struct iwl_bcast_filter_cmd cmd;
1147 char *buf;
1148 int bufsz = 1024;
1149 int i, pos = 0;
1150 ssize_t ret;
1151
1152 buf = kzalloc(bufsz, GFP_KERNEL);
1153 if (!buf)
1154 return -ENOMEM;
1155
1156 mutex_lock(&mvm->mutex);
1157 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd)) {
1158 ADD_TEXT("None\n");
1159 mutex_unlock(&mvm->mutex);
1160 goto out;
1161 }
1162 mutex_unlock(&mvm->mutex);
1163
1164 for (i = 0; i < ARRAY_SIZE(cmd.macs); i++) {
1165 const struct iwl_fw_bcast_mac *mac = &cmd.macs[i];
1166
1167 ADD_TEXT("Mac [%d]: discard=%d attached_filters=0x%x\n",
1168 i, mac->default_discard, mac->attached_filters);
1169 }
1170 out:
1171 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1172 kfree(buf);
1173 return ret;
1174 }
1175
1176 static ssize_t iwl_dbgfs_bcast_filters_macs_write(struct iwl_mvm *mvm,
1177 char *buf, size_t count,
1178 loff_t *ppos)
1179 {
1180 struct iwl_bcast_filter_cmd cmd;
1181 struct iwl_fw_bcast_mac mac = {};
1182 u32 mac_id, attached_filters;
1183 int err = 0;
1184
1185 if (!mvm->bcast_filters)
1186 return -ENOENT;
1187
1188 if (sscanf(buf, "%d %hhi %i", &mac_id, &mac.default_discard,
1189 &attached_filters) != 3)
1190 return -EINVAL;
1191
1192 if (mac_id >= ARRAY_SIZE(cmd.macs) ||
1193 mac.default_discard > 1 ||
1194 attached_filters >= BIT(ARRAY_SIZE(cmd.filters)))
1195 return -EINVAL;
1196
1197 mac.attached_filters = cpu_to_le16(attached_filters);
1198
1199 mutex_lock(&mvm->mutex);
1200 memcpy(&mvm->dbgfs_bcast_filtering.cmd.macs[mac_id],
1201 &mac, sizeof(mac));
1202
1203 /* send updated bcast filtering configuration */
1204 if (mvm->dbgfs_bcast_filtering.override &&
1205 iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1206 err = iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1207 sizeof(cmd), &cmd);
1208 mutex_unlock(&mvm->mutex);
1209
1210 return err ?: count;
1211 }
1212 #endif
1213
1214 #ifdef CONFIG_PM_SLEEP
1215 static ssize_t iwl_dbgfs_d3_sram_write(struct iwl_mvm *mvm, char *buf,
1216 size_t count, loff_t *ppos)
1217 {
1218 int store;
1219
1220 if (sscanf(buf, "%d", &store) != 1)
1221 return -EINVAL;
1222
1223 mvm->store_d3_resume_sram = store;
1224
1225 return count;
1226 }
1227
1228 static ssize_t iwl_dbgfs_d3_sram_read(struct file *file, char __user *user_buf,
1229 size_t count, loff_t *ppos)
1230 {
1231 struct iwl_mvm *mvm = file->private_data;
1232 const struct fw_img *img;
1233 int ofs, len, pos = 0;
1234 size_t bufsz, ret;
1235 char *buf;
1236 u8 *ptr = mvm->d3_resume_sram;
1237
1238 img = &mvm->fw->img[IWL_UCODE_WOWLAN];
1239 len = img->sec[IWL_UCODE_SECTION_DATA].len;
1240
1241 bufsz = len * 4 + 256;
1242 buf = kzalloc(bufsz, GFP_KERNEL);
1243 if (!buf)
1244 return -ENOMEM;
1245
1246 pos += scnprintf(buf, bufsz, "D3 SRAM capture: %sabled\n",
1247 mvm->store_d3_resume_sram ? "en" : "dis");
1248
1249 if (ptr) {
1250 for (ofs = 0; ofs < len; ofs += 16) {
1251 pos += scnprintf(buf + pos, bufsz - pos,
1252 "0x%.4x %16ph\n", ofs, ptr + ofs);
1253 }
1254 } else {
1255 pos += scnprintf(buf + pos, bufsz - pos,
1256 "(no data captured)\n");
1257 }
1258
1259 ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1260
1261 kfree(buf);
1262
1263 return ret;
1264 }
1265 #endif
1266
1267 #define PRINT_MVM_REF(ref) do { \
1268 if (mvm->refs[ref]) \
1269 pos += scnprintf(buf + pos, bufsz - pos, \
1270 "\t(0x%lx): %d %s\n", \
1271 BIT(ref), mvm->refs[ref], #ref); \
1272 } while (0)
1273
1274 static ssize_t iwl_dbgfs_d0i3_refs_read(struct file *file,
1275 char __user *user_buf,
1276 size_t count, loff_t *ppos)
1277 {
1278 struct iwl_mvm *mvm = file->private_data;
1279 int i, pos = 0;
1280 char buf[256];
1281 const size_t bufsz = sizeof(buf);
1282 u32 refs = 0;
1283
1284 for (i = 0; i < IWL_MVM_REF_COUNT; i++)
1285 if (mvm->refs[i])
1286 refs |= BIT(i);
1287
1288 pos += scnprintf(buf + pos, bufsz - pos, "taken mvm refs: 0x%x\n",
1289 refs);
1290
1291 PRINT_MVM_REF(IWL_MVM_REF_UCODE_DOWN);
1292 PRINT_MVM_REF(IWL_MVM_REF_SCAN);
1293 PRINT_MVM_REF(IWL_MVM_REF_ROC);
1294 PRINT_MVM_REF(IWL_MVM_REF_ROC_AUX);
1295 PRINT_MVM_REF(IWL_MVM_REF_P2P_CLIENT);
1296 PRINT_MVM_REF(IWL_MVM_REF_AP_IBSS);
1297 PRINT_MVM_REF(IWL_MVM_REF_USER);
1298 PRINT_MVM_REF(IWL_MVM_REF_TX);
1299 PRINT_MVM_REF(IWL_MVM_REF_TX_AGG);
1300 PRINT_MVM_REF(IWL_MVM_REF_ADD_IF);
1301 PRINT_MVM_REF(IWL_MVM_REF_START_AP);
1302 PRINT_MVM_REF(IWL_MVM_REF_BSS_CHANGED);
1303 PRINT_MVM_REF(IWL_MVM_REF_PREPARE_TX);
1304 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_TDLS);
1305 PRINT_MVM_REF(IWL_MVM_REF_CHECK_CTKILL);
1306 PRINT_MVM_REF(IWL_MVM_REF_PRPH_READ);
1307 PRINT_MVM_REF(IWL_MVM_REF_PRPH_WRITE);
1308 PRINT_MVM_REF(IWL_MVM_REF_NMI);
1309 PRINT_MVM_REF(IWL_MVM_REF_TM_CMD);
1310 PRINT_MVM_REF(IWL_MVM_REF_EXIT_WORK);
1311 PRINT_MVM_REF(IWL_MVM_REF_PROTECT_CSA);
1312 PRINT_MVM_REF(IWL_MVM_REF_FW_DBG_COLLECT);
1313 PRINT_MVM_REF(IWL_MVM_REF_INIT_UCODE);
1314 PRINT_MVM_REF(IWL_MVM_REF_SENDING_CMD);
1315 PRINT_MVM_REF(IWL_MVM_REF_RX);
1316
1317 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1318 }
1319
1320 static ssize_t iwl_dbgfs_d0i3_refs_write(struct iwl_mvm *mvm, char *buf,
1321 size_t count, loff_t *ppos)
1322 {
1323 unsigned long value;
1324 int ret;
1325 bool taken;
1326
1327 ret = kstrtoul(buf, 10, &value);
1328 if (ret < 0)
1329 return ret;
1330
1331 mutex_lock(&mvm->mutex);
1332
1333 taken = mvm->refs[IWL_MVM_REF_USER];
1334 if (value == 1 && !taken)
1335 iwl_mvm_ref(mvm, IWL_MVM_REF_USER);
1336 else if (value == 0 && taken)
1337 iwl_mvm_unref(mvm, IWL_MVM_REF_USER);
1338 else
1339 ret = -EINVAL;
1340
1341 mutex_unlock(&mvm->mutex);
1342
1343 if (ret < 0)
1344 return ret;
1345 return count;
1346 }
1347
1348 #define MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
1349 _MVM_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1350 #define MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
1351 _MVM_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_mvm)
1352 #define MVM_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do { \
1353 if (!debugfs_create_file(alias, mode, parent, mvm, \
1354 &iwl_dbgfs_##name##_ops)) \
1355 goto err; \
1356 } while (0)
1357 #define MVM_DEBUGFS_ADD_FILE(name, parent, mode) \
1358 MVM_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
1359
1360 static ssize_t
1361 iwl_dbgfs_prph_reg_read(struct file *file,
1362 char __user *user_buf,
1363 size_t count, loff_t *ppos)
1364 {
1365 struct iwl_mvm *mvm = file->private_data;
1366 int pos = 0;
1367 char buf[32];
1368 const size_t bufsz = sizeof(buf);
1369 int ret;
1370
1371 if (!mvm->dbgfs_prph_reg_addr)
1372 return -EINVAL;
1373
1374 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_READ);
1375 if (ret)
1376 return ret;
1377
1378 pos += scnprintf(buf + pos, bufsz - pos, "Reg 0x%x: (0x%x)\n",
1379 mvm->dbgfs_prph_reg_addr,
1380 iwl_read_prph(mvm->trans, mvm->dbgfs_prph_reg_addr));
1381
1382 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_READ);
1383
1384 return simple_read_from_buffer(user_buf, count, ppos, buf, pos);
1385 }
1386
1387 static ssize_t
1388 iwl_dbgfs_prph_reg_write(struct iwl_mvm *mvm, char *buf,
1389 size_t count, loff_t *ppos)
1390 {
1391 u8 args;
1392 u32 value;
1393 int ret;
1394
1395 args = sscanf(buf, "%i %i", &mvm->dbgfs_prph_reg_addr, &value);
1396 /* if we only want to set the reg address - nothing more to do */
1397 if (args == 1)
1398 goto out;
1399
1400 /* otherwise, make sure we have both address and value */
1401 if (args != 2)
1402 return -EINVAL;
1403
1404 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PRPH_WRITE);
1405 if (ret)
1406 return ret;
1407
1408 iwl_write_prph(mvm->trans, mvm->dbgfs_prph_reg_addr, value);
1409
1410 iwl_mvm_unref(mvm, IWL_MVM_REF_PRPH_WRITE);
1411 out:
1412 return count;
1413 }
1414
1415 static ssize_t
1416 iwl_dbgfs_send_echo_cmd_write(struct iwl_mvm *mvm, char *buf,
1417 size_t count, loff_t *ppos)
1418 {
1419 int ret;
1420
1421 mutex_lock(&mvm->mutex);
1422 ret = iwl_mvm_send_cmd_pdu(mvm, ECHO_CMD, 0, 0, NULL);
1423 mutex_unlock(&mvm->mutex);
1424
1425 return ret ?: count;
1426 }
1427
1428 MVM_DEBUGFS_READ_WRITE_FILE_OPS(prph_reg, 64);
1429
1430 /* Device wide debugfs entries */
1431 MVM_DEBUGFS_READ_FILE_OPS(ctdp_budget);
1432 MVM_DEBUGFS_WRITE_FILE_OPS(stop_ctdp, 8);
1433 MVM_DEBUGFS_WRITE_FILE_OPS(tx_flush, 16);
1434 MVM_DEBUGFS_WRITE_FILE_OPS(sta_drain, 8);
1435 MVM_DEBUGFS_WRITE_FILE_OPS(send_echo_cmd, 8);
1436 MVM_DEBUGFS_READ_WRITE_FILE_OPS(sram, 64);
1437 MVM_DEBUGFS_READ_WRITE_FILE_OPS(set_nic_temperature, 64);
1438 MVM_DEBUGFS_READ_FILE_OPS(nic_temp);
1439 MVM_DEBUGFS_READ_FILE_OPS(stations);
1440 MVM_DEBUGFS_READ_FILE_OPS(bt_notif);
1441 MVM_DEBUGFS_READ_FILE_OPS(bt_cmd);
1442 MVM_DEBUGFS_READ_WRITE_FILE_OPS(disable_power_off, 64);
1443 MVM_DEBUGFS_READ_FILE_OPS(fw_rx_stats);
1444 MVM_DEBUGFS_READ_FILE_OPS(drv_rx_stats);
1445 MVM_DEBUGFS_WRITE_FILE_OPS(fw_restart, 10);
1446 MVM_DEBUGFS_WRITE_FILE_OPS(fw_nmi, 10);
1447 MVM_DEBUGFS_WRITE_FILE_OPS(bt_tx_prio, 10);
1448 MVM_DEBUGFS_WRITE_FILE_OPS(bt_force_ant, 10);
1449 MVM_DEBUGFS_READ_WRITE_FILE_OPS(scan_ant_rxchain, 8);
1450 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d0i3_refs, 8);
1451 MVM_DEBUGFS_READ_WRITE_FILE_OPS(fw_dbg_conf, 8);
1452 MVM_DEBUGFS_WRITE_FILE_OPS(fw_dbg_collect, 64);
1453 MVM_DEBUGFS_WRITE_FILE_OPS(cont_recording, 8);
1454 MVM_DEBUGFS_WRITE_FILE_OPS(max_amsdu_len, 8);
1455 MVM_DEBUGFS_WRITE_FILE_OPS(indirection_tbl,
1456 (IWL_RSS_INDIRECTION_TABLE_SIZE * 2));
1457
1458 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1459 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters, 256);
1460 MVM_DEBUGFS_READ_WRITE_FILE_OPS(bcast_filters_macs, 256);
1461 #endif
1462
1463 #ifdef CONFIG_PM_SLEEP
1464 MVM_DEBUGFS_READ_WRITE_FILE_OPS(d3_sram, 8);
1465 #endif
1466
1467 int iwl_mvm_dbgfs_register(struct iwl_mvm *mvm, struct dentry *dbgfs_dir)
1468 {
1469 struct dentry *bcast_dir __maybe_unused;
1470 char buf[100];
1471
1472 spin_lock_init(&mvm->drv_stats_lock);
1473
1474 mvm->debugfs_dir = dbgfs_dir;
1475
1476 MVM_DEBUGFS_ADD_FILE(tx_flush, mvm->debugfs_dir, S_IWUSR);
1477 MVM_DEBUGFS_ADD_FILE(sta_drain, mvm->debugfs_dir, S_IWUSR);
1478 MVM_DEBUGFS_ADD_FILE(sram, mvm->debugfs_dir, S_IWUSR | S_IRUSR);
1479 MVM_DEBUGFS_ADD_FILE(set_nic_temperature, mvm->debugfs_dir,
1480 S_IWUSR | S_IRUSR);
1481 MVM_DEBUGFS_ADD_FILE(nic_temp, dbgfs_dir, S_IRUSR);
1482 MVM_DEBUGFS_ADD_FILE(ctdp_budget, dbgfs_dir, S_IRUSR);
1483 MVM_DEBUGFS_ADD_FILE(stop_ctdp, dbgfs_dir, S_IWUSR);
1484 MVM_DEBUGFS_ADD_FILE(stations, dbgfs_dir, S_IRUSR);
1485 MVM_DEBUGFS_ADD_FILE(bt_notif, dbgfs_dir, S_IRUSR);
1486 MVM_DEBUGFS_ADD_FILE(bt_cmd, dbgfs_dir, S_IRUSR);
1487 MVM_DEBUGFS_ADD_FILE(disable_power_off, mvm->debugfs_dir,
1488 S_IRUSR | S_IWUSR);
1489 MVM_DEBUGFS_ADD_FILE(fw_rx_stats, mvm->debugfs_dir, S_IRUSR);
1490 MVM_DEBUGFS_ADD_FILE(drv_rx_stats, mvm->debugfs_dir, S_IRUSR);
1491 MVM_DEBUGFS_ADD_FILE(fw_restart, mvm->debugfs_dir, S_IWUSR);
1492 MVM_DEBUGFS_ADD_FILE(fw_nmi, mvm->debugfs_dir, S_IWUSR);
1493 MVM_DEBUGFS_ADD_FILE(bt_tx_prio, mvm->debugfs_dir, S_IWUSR);
1494 MVM_DEBUGFS_ADD_FILE(bt_force_ant, mvm->debugfs_dir, S_IWUSR);
1495 MVM_DEBUGFS_ADD_FILE(scan_ant_rxchain, mvm->debugfs_dir,
1496 S_IWUSR | S_IRUSR);
1497 MVM_DEBUGFS_ADD_FILE(prph_reg, mvm->debugfs_dir, S_IWUSR | S_IRUSR);
1498 MVM_DEBUGFS_ADD_FILE(d0i3_refs, mvm->debugfs_dir, S_IRUSR | S_IWUSR);
1499 MVM_DEBUGFS_ADD_FILE(fw_dbg_conf, mvm->debugfs_dir, S_IRUSR | S_IWUSR);
1500 MVM_DEBUGFS_ADD_FILE(fw_dbg_collect, mvm->debugfs_dir, S_IWUSR);
1501 MVM_DEBUGFS_ADD_FILE(max_amsdu_len, mvm->debugfs_dir, S_IWUSR);
1502 MVM_DEBUGFS_ADD_FILE(send_echo_cmd, mvm->debugfs_dir, S_IWUSR);
1503 MVM_DEBUGFS_ADD_FILE(cont_recording, mvm->debugfs_dir, S_IWUSR);
1504 MVM_DEBUGFS_ADD_FILE(indirection_tbl, mvm->debugfs_dir, S_IWUSR);
1505 if (!debugfs_create_bool("enable_scan_iteration_notif",
1506 S_IRUSR | S_IWUSR,
1507 mvm->debugfs_dir,
1508 &mvm->scan_iter_notif_enabled))
1509 goto err;
1510 if (!debugfs_create_bool("drop_bcn_ap_mode", S_IRUSR | S_IWUSR,
1511 mvm->debugfs_dir, &mvm->drop_bcn_ap_mode))
1512 goto err;
1513
1514 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1515 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING) {
1516 bcast_dir = debugfs_create_dir("bcast_filtering",
1517 mvm->debugfs_dir);
1518 if (!bcast_dir)
1519 goto err;
1520
1521 if (!debugfs_create_bool("override", S_IRUSR | S_IWUSR,
1522 bcast_dir,
1523 &mvm->dbgfs_bcast_filtering.override))
1524 goto err;
1525
1526 MVM_DEBUGFS_ADD_FILE_ALIAS("filters", bcast_filters,
1527 bcast_dir, S_IWUSR | S_IRUSR);
1528 MVM_DEBUGFS_ADD_FILE_ALIAS("macs", bcast_filters_macs,
1529 bcast_dir, S_IWUSR | S_IRUSR);
1530 }
1531 #endif
1532
1533 #ifdef CONFIG_PM_SLEEP
1534 MVM_DEBUGFS_ADD_FILE(d3_sram, mvm->debugfs_dir, S_IRUSR | S_IWUSR);
1535 MVM_DEBUGFS_ADD_FILE(d3_test, mvm->debugfs_dir, S_IRUSR);
1536 if (!debugfs_create_bool("d3_wake_sysassert", S_IRUSR | S_IWUSR,
1537 mvm->debugfs_dir, &mvm->d3_wake_sysassert))
1538 goto err;
1539 if (!debugfs_create_u32("last_netdetect_scans", S_IRUSR,
1540 mvm->debugfs_dir, &mvm->last_netdetect_scans))
1541 goto err;
1542 #endif
1543
1544 if (!debugfs_create_u8("ps_disabled", S_IRUSR,
1545 mvm->debugfs_dir, &mvm->ps_disabled))
1546 goto err;
1547 if (!debugfs_create_blob("nvm_hw", S_IRUSR,
1548 mvm->debugfs_dir, &mvm->nvm_hw_blob))
1549 goto err;
1550 if (!debugfs_create_blob("nvm_sw", S_IRUSR,
1551 mvm->debugfs_dir, &mvm->nvm_sw_blob))
1552 goto err;
1553 if (!debugfs_create_blob("nvm_calib", S_IRUSR,
1554 mvm->debugfs_dir, &mvm->nvm_calib_blob))
1555 goto err;
1556 if (!debugfs_create_blob("nvm_prod", S_IRUSR,
1557 mvm->debugfs_dir, &mvm->nvm_prod_blob))
1558 goto err;
1559 if (!debugfs_create_blob("nvm_phy_sku", S_IRUSR,
1560 mvm->debugfs_dir, &mvm->nvm_phy_sku_blob))
1561 goto err;
1562
1563 /*
1564 * Create a symlink with mac80211. It will be removed when mac80211
1565 * exists (before the opmode exists which removes the target.)
1566 */
1567 snprintf(buf, 100, "../../%s/%s",
1568 dbgfs_dir->d_parent->d_parent->d_name.name,
1569 dbgfs_dir->d_parent->d_name.name);
1570 if (!debugfs_create_symlink("iwlwifi", mvm->hw->wiphy->debugfsdir, buf))
1571 goto err;
1572
1573 return 0;
1574 err:
1575 IWL_ERR(mvm, "Can't create the mvm debugfs directory\n");
1576 return -ENOMEM;
1577 }
Linux kernel - Deliverables
This page took 0.068093 seconds and 5 git commands to generate.