cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

debugfs.c (54350B)


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