// SPDX-License-Identifier: GPL-2.0-only /* * nxpwifi: debugfs * * Copyright 2011-2024 NXP */ #include #include "main.h" #include "cmdevt.h" #include "11n.h" static struct dentry *nxpwifi_dfs_dir; static char *bss_modes[] = { "UNSPECIFIED", "ADHOC", "STATION", "AP", "AP_VLAN", "WDS", "MONITOR", "MESH_POINT", "P2P_CLIENT", "P2P_GO", "P2P_DEVICE", }; /* * debugfs "info" read handler: dump driver name/version, interface, BSS mode, * link state, MAC, counters; STA adds SSID/BSSID/channel/country/region and * multicast list. */ static ssize_t nxpwifi_info_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; struct net_device *netdev = priv->netdev; struct netdev_hw_addr *ha; struct netdev_queue *txq; unsigned long page = get_zeroed_page(GFP_KERNEL); char *p = (char *)page, fmt[64]; struct nxpwifi_bss_info info; ssize_t ret; int i = 0; if (!p) return -ENOMEM; memset(&info, 0, sizeof(info)); ret = nxpwifi_get_bss_info(priv, &info); if (ret) goto free_and_exit; nxpwifi_drv_get_driver_version(priv->adapter, fmt, sizeof(fmt) - 1); nxpwifi_get_ver_ext(priv, 0); p += sprintf(p, "driver_name = "); p += sprintf(p, "\"nxpwifi\"\n"); p += sprintf(p, "driver_version = %s", fmt); p += sprintf(p, "\nverext = %s", priv->version_str); p += sprintf(p, "\ninterface_name=\"%s\"\n", netdev->name); if (info.bss_mode >= ARRAY_SIZE(bss_modes)) p += sprintf(p, "bss_mode=\"%d\"\n", info.bss_mode); else p += sprintf(p, "bss_mode=\"%s\"\n", bss_modes[info.bss_mode]); p += sprintf(p, "media_state=\"%s\"\n", (!priv->media_connected ? "Disconnected" : "Connected")); p += sprintf(p, "mac_address=\"%pM\"\n", netdev->dev_addr); if (GET_BSS_ROLE(priv) == NXPWIFI_BSS_ROLE_STA) { p += sprintf(p, "multicast_count=\"%d\"\n", netdev_mc_count(netdev)); p += sprintf(p, "essid=\"%.*s\"\n", info.ssid.ssid_len, info.ssid.ssid); p += sprintf(p, "bssid=\"%pM\"\n", info.bssid); p += sprintf(p, "channel=\"%d\"\n", (int)info.bss_chan); p += sprintf(p, "country_code = \"%s\"\n", info.country_code); p += sprintf(p, "region_code=\"0x%x\"\n", priv->adapter->region_code); netdev_for_each_mc_addr(ha, netdev) p += sprintf(p, "multicast_address[%d]=\"%pM\"\n", i++, ha->addr); } p += sprintf(p, "num_tx_bytes = %lu\n", priv->stats.tx_bytes); p += sprintf(p, "num_rx_bytes = %lu\n", priv->stats.rx_bytes); p += sprintf(p, "num_tx_pkts = %lu\n", priv->stats.tx_packets); p += sprintf(p, "num_rx_pkts = %lu\n", priv->stats.rx_packets); p += sprintf(p, "num_tx_pkts_dropped = %lu\n", priv->stats.tx_dropped); p += sprintf(p, "num_rx_pkts_dropped = %lu\n", priv->stats.rx_dropped); p += sprintf(p, "num_tx_pkts_err = %lu\n", priv->stats.tx_errors); p += sprintf(p, "num_rx_pkts_err = %lu\n", priv->stats.rx_errors); p += sprintf(p, "carrier %s\n", ((netif_carrier_ok(priv->netdev)) ? "on" : "off")); p += sprintf(p, "tx queue"); for (i = 0; i < netdev->num_tx_queues; i++) { txq = netdev_get_tx_queue(netdev, i); p += sprintf(p, " %d:%s", i, netif_tx_queue_stopped(txq) ? "stopped" : "started"); } p += sprintf(p, "\n"); ret = simple_read_from_buffer(ubuf, count, ppos, (char *)page, (unsigned long)p - page); free_and_exit: free_page(page); return ret; } /* * debugfs "getlog" read handler: dump firmware/802.11 counters (retry, RTS/ACK, dup, * frag, mcast, FCS, beacon stats). */ static ssize_t nxpwifi_getlog_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; unsigned long page = get_zeroed_page(GFP_KERNEL); char *p = (char *)page; ssize_t ret; struct nxpwifi_ds_get_stats stats; if (!p) return -ENOMEM; memset(&stats, 0, sizeof(stats)); ret = nxpwifi_get_stats_info(priv, &stats); if (ret) goto free_and_exit; p += sprintf(p, "\n" "mcasttxframe %u\n" "failed %u\n" "retry %u\n" "multiretry %u\n" "framedup %u\n" "rtssuccess %u\n" "rtsfailure %u\n" "ackfailure %u\n" "rxfrag %u\n" "mcastrxframe %u\n" "fcserror %u\n" "txframe %u\n" "wepicverrcnt-1 %u\n" "wepicverrcnt-2 %u\n" "wepicverrcnt-3 %u\n" "wepicverrcnt-4 %u\n" "bcn_rcv_cnt %u\n" "bcn_miss_cnt %u\n", stats.mcast_tx_frame, stats.failed, stats.retry, stats.multi_retry, stats.frame_dup, stats.rts_success, stats.rts_failure, stats.ack_failure, stats.rx_frag, stats.mcast_rx_frame, stats.fcs_error, stats.tx_frame, stats.wep_icv_error[0], stats.wep_icv_error[1], stats.wep_icv_error[2], stats.wep_icv_error[3], stats.bcn_rcv_cnt, stats.bcn_miss_cnt); ret = simple_read_from_buffer(ubuf, count, ppos, (char *)page, (unsigned long)p - page); free_and_exit: free_page(page); return ret; } /* * debugfs "histogram" read handler: report sample count and per-rate/SNR/noise * floor/signal strength histograms. */ static ssize_t nxpwifi_histogram_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; ssize_t ret; struct nxpwifi_histogram_data *phist_data; int i, value; unsigned long page = get_zeroed_page(GFP_KERNEL); char *p = (char *)page; if (!p) return -ENOMEM; if (!priv || !priv->hist_data) { ret = -EFAULT; goto free_and_exit; } phist_data = priv->hist_data; p += sprintf(p, "\n" "total samples = %d\n", atomic_read(&phist_data->num_samples)); p += sprintf(p, "rx rates (in Mbps): 0=1M 1=2M 2=5.5M 3=11M 4=6M 5=9M 6=12M\n" "7=18M 8=24M 9=36M 10=48M 11=54M 12-27=MCS0-15(BW20) 28-43=MCS0-15(BW40)\n"); if (ISSUPP_11ACENABLED(priv->adapter->fw_cap_info)) { p += sprintf(p, "44-53=MCS0-9(VHT:BW20) 54-63=MCS0-9(VHT:BW40) 64-73=MCS0-9(VHT:BW80)\n\n"); } else { p += sprintf(p, "\n"); } for (i = 0; i < NXPWIFI_MAX_RX_RATES; i++) { value = atomic_read(&phist_data->rx_rate[i]); if (value) p += sprintf(p, "rx_rate[%02d] = %d\n", i, value); } if (ISSUPP_11ACENABLED(priv->adapter->fw_cap_info)) { for (i = NXPWIFI_MAX_RX_RATES; i < NXPWIFI_MAX_AC_RX_RATES; i++) { value = atomic_read(&phist_data->rx_rate[i]); if (value) p += sprintf(p, "rx_rate[%02d] = %d\n", i, value); } } for (i = 0; i < NXPWIFI_MAX_SNR; i++) { value = atomic_read(&phist_data->snr[i]); if (value) p += sprintf(p, "snr[%02ddB] = %d\n", i, value); } for (i = 0; i < NXPWIFI_MAX_NOISE_FLR; i++) { value = atomic_read(&phist_data->noise_flr[i]); if (value) p += sprintf(p, "noise_flr[%02ddBm] = %d\n", (int)(i - 128), value); } for (i = 0; i < NXPWIFI_MAX_SIG_STRENGTH; i++) { value = atomic_read(&phist_data->sig_str[i]); if (value) p += sprintf(p, "sig_strength[-%02ddBm] = %d\n", i, value); } ret = simple_read_from_buffer(ubuf, count, ppos, (char *)page, (unsigned long)p - page); free_and_exit: free_page(page); return ret; } static ssize_t nxpwifi_histogram_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (void *)file->private_data; if (priv && priv->hist_data) nxpwifi_hist_data_reset(priv); return 0; } static struct nxpwifi_debug_info info; /* debugfs "debug" read handler: dump adapter debug info and BA/reorder tables. */ static ssize_t nxpwifi_debug_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; unsigned long page = get_zeroed_page(GFP_KERNEL); char *p = (char *)page; ssize_t ret; if (!p) return -ENOMEM; ret = nxpwifi_get_debug_info(priv, &info); if (ret) goto free_and_exit; p += nxpwifi_debug_info_to_buffer(priv, p, &info); ret = simple_read_from_buffer(ubuf, count, ppos, (char *)page, (unsigned long)p - page); free_and_exit: free_page(page); return ret; } static u32 saved_reg_type, saved_reg_offset, saved_reg_value; /* * debugfs "regrdwr" write handler: parse and store for * readback/IO. */ static ssize_t nxpwifi_regrdwr_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { char *buf; int ret; u32 reg_type = 0, reg_offset = 0, reg_value = UINT_MAX; int rv; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); rv = sscanf(buf, "%u %x %x", ®_type, ®_offset, ®_value); if (rv != 3) { ret = -EINVAL; goto done; } if (reg_type == 0 || reg_offset == 0) { ret = -EINVAL; goto done; } else { saved_reg_type = reg_type; saved_reg_offset = reg_offset; saved_reg_value = reg_value; ret = count; } done: kfree(buf); return ret; } /* * debugfs "regrdwr" read handler: perform pending register read/write and return * . */ static ssize_t nxpwifi_regrdwr_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; unsigned long addr = get_zeroed_page(GFP_KERNEL); char *buf = (char *)addr; int pos = 0, ret = 0; u32 reg_value; if (!buf) return -ENOMEM; if (!saved_reg_type) { /* No command has been given */ pos += snprintf(buf, PAGE_SIZE, "0"); goto done; } /* Set command has been given */ if (saved_reg_value != UINT_MAX) { ret = nxpwifi_reg_write(priv, saved_reg_type, saved_reg_offset, saved_reg_value); pos += snprintf(buf, PAGE_SIZE, "%u 0x%x 0x%x\n", saved_reg_type, saved_reg_offset, saved_reg_value); ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); goto done; } /* Get command has been given */ ret = nxpwifi_reg_read(priv, saved_reg_type, saved_reg_offset, ®_value); if (ret) { ret = -EINVAL; goto done; } pos += snprintf(buf, PAGE_SIZE, "%u 0x%x 0x%x\n", saved_reg_type, saved_reg_offset, reg_value); ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); done: free_page(addr); return ret; } /* debugfs "debug_mask" read handler: show driver debug mask. */ static ssize_t nxpwifi_debug_mask_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; unsigned long page = get_zeroed_page(GFP_KERNEL); char *buf = (char *)page; size_t ret = 0; int pos = 0; if (!buf) return -ENOMEM; pos += snprintf(buf, PAGE_SIZE, "debug mask=0x%08x\n", priv->adapter->debug_mask); ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); free_page(page); return ret; } /* debugfs "debug_mask" write handler: set driver debug mask. */ static ssize_t nxpwifi_debug_mask_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; unsigned long debug_mask; struct nxpwifi_private *priv = (void *)file->private_data; char *buf; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); if (kstrtoul(buf, 0, &debug_mask)) { ret = -EINVAL; goto done; } priv->adapter->debug_mask = debug_mask; ret = count; done: kfree(buf); return ret; } /* debugfs "verext" write handler: select extended version string. */ static ssize_t nxpwifi_verext_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; u32 versionstrsel; struct nxpwifi_private *priv = (void *)file->private_data; ret = kstrtou32_from_user(ubuf, count, 10, &versionstrsel); if (ret) return ret; priv->versionstrsel = versionstrsel; return count; } /* debugfs "verext" read handler: show extended version string. */ static ssize_t nxpwifi_verext_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; char buf[256]; int ret; nxpwifi_get_ver_ext(priv, priv->versionstrsel); ret = snprintf(buf, sizeof(buf), "version string: %s\n", priv->version_str); return simple_read_from_buffer(ubuf, count, ppos, buf, ret); } /* debugfs "memrw" write handler: read/write firmware memory (addr, value). */ static ssize_t nxpwifi_memrw_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; char cmd; struct nxpwifi_ds_mem_rw mem_rw; u16 cmd_action; struct nxpwifi_private *priv = (void *)file->private_data; char *buf; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); ret = sscanf(buf, "%c %x %x", &cmd, &mem_rw.addr, &mem_rw.value); if (ret != 3) { ret = -EINVAL; goto done; } if ((cmd == 'r') || (cmd == 'R')) { cmd_action = HOST_ACT_GEN_GET; mem_rw.value = 0; } else if ((cmd == 'w') || (cmd == 'W')) { cmd_action = HOST_ACT_GEN_SET; } else { ret = -EINVAL; goto done; } memcpy(&priv->mem_rw, &mem_rw, sizeof(mem_rw)); ret = nxpwifi_send_cmd(priv, HOST_CMD_MEM_ACCESS, cmd_action, 0, &mem_rw, true); if (!ret) ret = count; done: kfree(buf); return ret; } /* debugfs "memrw" read handler: show last memory access result. */ static ssize_t nxpwifi_memrw_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (void *)file->private_data; unsigned long addr = get_zeroed_page(GFP_KERNEL); char *buf = (char *)addr; int ret, pos = 0; if (!buf) return -ENOMEM; pos += snprintf(buf, PAGE_SIZE, "0x%x 0x%x\n", priv->mem_rw.addr, priv->mem_rw.value); ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); free_page(addr); return ret; } static u32 saved_offset = -1, saved_bytes = -1; /* debugfs "rdeeprom" write handler: set EEPROM offset/length to read. */ static ssize_t nxpwifi_rdeeprom_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { char *buf; int ret = 0; int offset = -1, bytes = -1; int rv; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); rv = sscanf(buf, "%d %d", &offset, &bytes); if (rv != 2) { ret = -EINVAL; goto done; } if (offset == -1 || bytes == -1) { ret = -EINVAL; goto done; } else { saved_offset = offset; saved_bytes = bytes; ret = count; } done: kfree(buf); return ret; } /* debugfs "rdeeprom" read handler: dump EEPROM bytes from saved offset/length. */ static ssize_t nxpwifi_rdeeprom_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; unsigned long addr = get_zeroed_page(GFP_KERNEL); char *buf = (char *)addr; int pos, ret, i; u8 value[MAX_EEPROM_DATA]; if (!buf) return -ENOMEM; if (saved_offset == -1) { /* No command has been given */ pos = snprintf(buf, PAGE_SIZE, "0"); goto done; } /* Get command has been given */ ret = nxpwifi_eeprom_read(priv, (u16)saved_offset, (u16)saved_bytes, value); if (ret) { ret = -EINVAL; goto out_free; } pos = snprintf(buf, PAGE_SIZE, "%d %d ", saved_offset, saved_bytes); for (i = 0; i < saved_bytes; i++) pos += scnprintf(buf + pos, PAGE_SIZE - pos, "%d ", value[i]); done: ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); out_free: free_page(addr); return ret; } /* * debugfs "hscfg" write handler: configure host-sleep (conditions/gpio/gap) or * cancel. */ static ssize_t nxpwifi_hscfg_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (void *)file->private_data; char *buf; int ret, arg_num; struct nxpwifi_ds_hs_cfg hscfg; int conditions = HS_CFG_COND_DEF; u32 gpio = HS_CFG_GPIO_DEF, gap = HS_CFG_GAP_DEF; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); arg_num = sscanf(buf, "%d %x %x", &conditions, &gpio, &gap); memset(&hscfg, 0, sizeof(struct nxpwifi_ds_hs_cfg)); if (arg_num > 3) { nxpwifi_dbg(priv->adapter, ERROR, "Too many arguments\n"); ret = -EINVAL; goto done; } if (arg_num >= 1 && arg_num < 3) nxpwifi_set_hs_params(priv, HOST_ACT_GEN_GET, NXPWIFI_SYNC_CMD, &hscfg); if (arg_num) { if (conditions == HS_CFG_CANCEL) { nxpwifi_cancel_hs(priv, NXPWIFI_ASYNC_CMD); ret = count; goto done; } hscfg.conditions = conditions; } if (arg_num >= 2) hscfg.gpio = gpio; if (arg_num == 3) hscfg.gap = gap; hscfg.is_invoke_hostcmd = false; nxpwifi_set_hs_params(priv, HOST_ACT_GEN_SET, NXPWIFI_SYNC_CMD, &hscfg); nxpwifi_enable_hs(priv->adapter); clear_bit(NXPWIFI_IS_HS_ENABLING, &priv->adapter->work_flags); ret = count; done: kfree(buf); return ret; } /* debugfs "hscfg" read handler: show current host-sleep configuration. */ static ssize_t nxpwifi_hscfg_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (void *)file->private_data; unsigned long addr = get_zeroed_page(GFP_KERNEL); char *buf = (char *)addr; int pos, ret; struct nxpwifi_ds_hs_cfg hscfg; if (!buf) return -ENOMEM; nxpwifi_set_hs_params(priv, HOST_ACT_GEN_GET, NXPWIFI_SYNC_CMD, &hscfg); pos = snprintf(buf, PAGE_SIZE, "%u 0x%x 0x%x\n", hscfg.conditions, hscfg.gpio, hscfg.gap); ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); free_page(addr); return ret; } static ssize_t nxpwifi_timeshare_coex_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = file->private_data; char buf[3]; bool timeshare_coex; int ret; unsigned int len; if (priv->adapter->fw_api_ver != NXPWIFI_FW_V15) return -EOPNOTSUPP; ret = nxpwifi_send_cmd(priv, HOST_CMD_ROBUST_COEX, HOST_ACT_GEN_GET, 0, ×hare_coex, true); if (ret) return ret; len = sprintf(buf, "%d\n", timeshare_coex); return simple_read_from_buffer(ubuf, count, ppos, buf, len); } static ssize_t nxpwifi_timeshare_coex_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { bool timeshare_coex; struct nxpwifi_private *priv = file->private_data; int ret; if (priv->adapter->fw_api_ver != NXPWIFI_FW_V15) return -EOPNOTSUPP; ret = kstrtobool_from_user(ubuf, count, ×hare_coex); if (ret) return ret; ret = nxpwifi_send_cmd(priv, HOST_CMD_ROBUST_COEX, HOST_ACT_GEN_SET, 0, ×hare_coex, true); if (ret) return ret; else return count; } static ssize_t nxpwifi_reset_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = file->private_data; struct nxpwifi_adapter *adapter = priv->adapter; bool result; int rc; rc = kstrtobool_from_user(ubuf, count, &result); if (rc) return rc; if (!result) return -EINVAL; if (adapter->if_ops.card_reset) { nxpwifi_dbg(adapter, INFO, "Resetting per request\n"); adapter->if_ops.card_reset(adapter); } return count; } static ssize_t nxpwifi_fake_radar_detect_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = file->private_data; struct nxpwifi_adapter *adapter = priv->adapter; bool result; int rc; rc = kstrtobool_from_user(ubuf, count, &result); if (rc) return rc; if (!result) return -EINVAL; if (priv->wdev.links[0].cac_started) { nxpwifi_dbg(adapter, MSG, "Generate fake radar detected during CAC\n"); if (nxpwifi_stop_radar_detection(priv, &priv->dfs_chandef)) nxpwifi_dbg(adapter, ERROR, "Failed to stop CAC in FW\n"); wiphy_delayed_work_cancel(priv->adapter->wiphy, &priv->dfs_cac_work); cfg80211_cac_event(priv->netdev, &priv->dfs_chandef, NL80211_RADAR_CAC_ABORTED, GFP_KERNEL, 0); cfg80211_radar_event(adapter->wiphy, &priv->dfs_chandef, GFP_KERNEL); } else { if (priv->bss_chandef.chan->dfs_cac_ms) { nxpwifi_dbg(adapter, MSG, "Generate fake radar detected\n"); cfg80211_radar_event(adapter->wiphy, &priv->dfs_chandef, GFP_KERNEL); } } return count; } static ssize_t nxpwifi_netmon_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; struct nxpwifi_802_11_net_monitor netmon_cfg; struct nxpwifi_private *priv = (void *)file->private_data; char *buf; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); memset(&netmon_cfg, 0, sizeof(struct nxpwifi_802_11_net_monitor)); ret = sscanf(buf, "%u %u %u %u %u", &netmon_cfg.enable_net_mon, &netmon_cfg.filter_flag, &netmon_cfg.band, &netmon_cfg.channel, &netmon_cfg.chan_bandwidth); ret = nxpwifi_send_cmd(priv, HOST_CMD_802_11_NET_MONITOR, HOST_ACT_GEN_SET, 0, &netmon_cfg, true); if (!ret) ret = count; kfree(buf); return ret; } static ssize_t nxpwifi_twt_setup_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; struct nxpwifi_twt_cfg twt_cfg; struct nxpwifi_private *priv = (void *)file->private_data; char *buf; u16 twt_mantissa, bcn_miss_threshold; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); ret = sscanf(buf, "%hhu %hhu %hhu %hhu %hhu %hhu %hhu %hhu %hhu %hu %hhu %hu", &twt_cfg.param.twt_setup.implicit, &twt_cfg.param.twt_setup.announced, &twt_cfg.param.twt_setup.trigger_enabled, &twt_cfg.param.twt_setup.twt_info_disabled, &twt_cfg.param.twt_setup.negotiation_type, &twt_cfg.param.twt_setup.twt_wakeup_duration, &twt_cfg.param.twt_setup.flow_identifier, &twt_cfg.param.twt_setup.hard_constraint, &twt_cfg.param.twt_setup.twt_exponent, &twt_mantissa, &twt_cfg.param.twt_setup.twt_request, &bcn_miss_threshold); twt_cfg.param.twt_setup.twt_mantissa = cpu_to_le16(twt_mantissa); twt_cfg.param.twt_setup.bcn_miss_threshold = cpu_to_le16(bcn_miss_threshold); twt_cfg.sub_id = NXPWIFI_11AX_TWT_SETUP_SUBID; ret = nxpwifi_send_cmd(priv, HOST_CMD_TWT_CFG, HOST_ACT_GEN_SET, 0, &twt_cfg, true); if (!ret) ret = count; kfree(buf); return ret; } static ssize_t nxpwifi_twt_teardown_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; struct nxpwifi_twt_cfg twt_cfg; struct nxpwifi_private *priv = (void *)file->private_data; char *buf; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); ret = sscanf(buf, "%hhu %hhu %hhu", &twt_cfg.param.twt_teardown.flow_identifier, &twt_cfg.param.twt_teardown.negotiation_type, &twt_cfg.param.twt_teardown.teardown_all_twt); twt_cfg.sub_id = NXPWIFI_11AX_TWT_TEARDOWN_SUBID; ret = nxpwifi_send_cmd(priv, HOST_CMD_TWT_CFG, HOST_ACT_GEN_SET, 0, &twt_cfg, true); if (!ret) ret = count; kfree(buf); return ret; } static ssize_t nxpwifi_twt_report_read(struct file *file, char __user *ubuf, size_t count, loff_t *ppos) { struct nxpwifi_private *priv = (struct nxpwifi_private *)file->private_data; unsigned long page = get_zeroed_page(GFP_KERNEL); char *p = (char *)page; ssize_t ret; struct nxpwifi_twt_cfg twt_cfg; u8 num, i, j; if (!p) return -ENOMEM; twt_cfg.sub_id = NXPWIFI_11AX_TWT_REPORT_SUBID; ret = nxpwifi_send_cmd(priv, HOST_CMD_TWT_CFG, HOST_ACT_GEN_GET, 0, &twt_cfg, true); if (ret) goto done; num = twt_cfg.param.twt_report.length / NXPWIFI_BTWT_REPORT_LEN; num = num <= NXPWIFI_BTWT_REPORT_MAX_NUM ? num : NXPWIFI_BTWT_REPORT_MAX_NUM; p += sprintf(p, "\ntwt_report len %hhu, num %hhu, twt_report_info:\n", twt_cfg.param.twt_report.length, num); for (i = 0; i < num; i++) { p += sprintf(p, "id[%hu]:\r\n", i); for (j = 0; j < NXPWIFI_BTWT_REPORT_LEN; j++) { p += sprintf(p, " 0x%02x", twt_cfg.param.twt_report.data[i * NXPWIFI_BTWT_REPORT_LEN + j]); } p += sprintf(p, "\r\n"); } ret = simple_read_from_buffer(ubuf, count, ppos, (char *)page, (unsigned long)p - page); done: free_page(page); return ret; } static ssize_t nxpwifi_twt_information_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos) { int ret; struct nxpwifi_twt_cfg twt_cfg; struct nxpwifi_private *priv = (void *)file->private_data; char *buf; u32 suspend_duration; buf = memdup_user_nul(ubuf, min(count, (size_t)(PAGE_SIZE - 1))); if (IS_ERR(buf)) return PTR_ERR(buf); ret = sscanf(buf, "%hhu %u", &twt_cfg.param.twt_information.flow_identifier, &suspend_duration); twt_cfg.param.twt_information.suspend_duration = cpu_to_le32(suspend_duration); twt_cfg.sub_id = NXPWIFI_11AX_TWT_INFORMATION_SUBID; ret = nxpwifi_send_cmd(priv, HOST_CMD_TWT_CFG, HOST_ACT_GEN_SET, 0, &twt_cfg, true); if (!ret) ret = count; kfree(buf); return ret; } #define NXPWIFI_DFS_ADD_FILE(name) debugfs_create_file(#name, 0644, \ priv->dfs_dev_dir, priv, \ &nxpwifi_dfs_##name##_fops) #define NXPWIFI_DFS_FILE_OPS(name) \ static const struct file_operations nxpwifi_dfs_##name##_fops = { \ .read = nxpwifi_##name##_read, \ .write = nxpwifi_##name##_write, \ .open = simple_open, \ } #define NXPWIFI_DFS_FILE_READ_OPS(name) \ static const struct file_operations nxpwifi_dfs_##name##_fops = { \ .read = nxpwifi_##name##_read, \ .open = simple_open, \ } #define NXPWIFI_DFS_FILE_WRITE_OPS(name) \ static const struct file_operations nxpwifi_dfs_##name##_fops = { \ .write = nxpwifi_##name##_write, \ .open = simple_open, \ } NXPWIFI_DFS_FILE_READ_OPS(info); NXPWIFI_DFS_FILE_READ_OPS(debug); NXPWIFI_DFS_FILE_READ_OPS(getlog); NXPWIFI_DFS_FILE_OPS(regrdwr); NXPWIFI_DFS_FILE_OPS(rdeeprom); NXPWIFI_DFS_FILE_OPS(memrw); NXPWIFI_DFS_FILE_OPS(hscfg); NXPWIFI_DFS_FILE_OPS(histogram); NXPWIFI_DFS_FILE_OPS(debug_mask); NXPWIFI_DFS_FILE_OPS(timeshare_coex); NXPWIFI_DFS_FILE_WRITE_OPS(reset); NXPWIFI_DFS_FILE_WRITE_OPS(fake_radar_detect); NXPWIFI_DFS_FILE_OPS(verext); NXPWIFI_DFS_FILE_WRITE_OPS(netmon); NXPWIFI_DFS_FILE_WRITE_OPS(twt_setup); NXPWIFI_DFS_FILE_WRITE_OPS(twt_teardown); NXPWIFI_DFS_FILE_READ_OPS(twt_report); NXPWIFI_DFS_FILE_WRITE_OPS(twt_information); /* Create per-netdev debugfs directory and files. */ void nxpwifi_dev_debugfs_init(struct nxpwifi_private *priv) { if (!nxpwifi_dfs_dir || !priv) return; priv->dfs_dev_dir = debugfs_create_dir(priv->netdev->name, nxpwifi_dfs_dir); NXPWIFI_DFS_ADD_FILE(info); NXPWIFI_DFS_ADD_FILE(debug); NXPWIFI_DFS_ADD_FILE(getlog); NXPWIFI_DFS_ADD_FILE(regrdwr); NXPWIFI_DFS_ADD_FILE(rdeeprom); NXPWIFI_DFS_ADD_FILE(memrw); NXPWIFI_DFS_ADD_FILE(hscfg); NXPWIFI_DFS_ADD_FILE(histogram); NXPWIFI_DFS_ADD_FILE(debug_mask); NXPWIFI_DFS_ADD_FILE(timeshare_coex); NXPWIFI_DFS_ADD_FILE(reset); NXPWIFI_DFS_ADD_FILE(fake_radar_detect); NXPWIFI_DFS_ADD_FILE(verext); NXPWIFI_DFS_ADD_FILE(netmon); NXPWIFI_DFS_ADD_FILE(twt_setup); NXPWIFI_DFS_ADD_FILE(twt_teardown); NXPWIFI_DFS_ADD_FILE(twt_report); NXPWIFI_DFS_ADD_FILE(twt_information); } /* Remove per-netdev debugfs directory and files. */ void nxpwifi_dev_debugfs_remove(struct nxpwifi_private *priv) { if (!priv) return; debugfs_remove_recursive(priv->dfs_dev_dir); } /* Create top-level debugfs directory. */ void nxpwifi_debugfs_init(void) { if (!nxpwifi_dfs_dir) nxpwifi_dfs_dir = debugfs_create_dir("nxpwifi", NULL); } /* Remove top-level debugfs directory. */ void nxpwifi_debugfs_remove(void) { debugfs_remove(nxpwifi_dfs_dir); }