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