| /* |
| * Copyright (c) 2013-2016 The Linux Foundation. All rights reserved. |
| * |
| * Previously licensed under the ISC license by Qualcomm Atheros, Inc. |
| * |
| * |
| * Permission to use, copy, modify, and/or distribute this software for |
| * any purpose with or without fee is hereby granted, provided that the |
| * above copyright notice and this permission notice appear in all |
| * copies. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL |
| * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED |
| * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE |
| * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL |
| * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR |
| * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER |
| * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR |
| * PERFORMANCE OF THIS SOFTWARE. |
| */ |
| |
| /* |
| * This file was originally distributed by Qualcomm Atheros, Inc. |
| * under proprietary terms before Copyright ownership was assigned |
| * to the Linux Foundation. |
| */ |
| |
| /** |
| * DOC: wlan_hdd_debugfs.c |
| * |
| * This driver currently supports the following debugfs files: |
| * wlan_wcnss/wow_enable to enable/disable WoWL. |
| * wlan_wcnss/wow_pattern to configure WoWL patterns. |
| * wlan_wcnss/pattern_gen to configure periodic TX patterns. |
| */ |
| |
| #ifdef WLAN_OPEN_SOURCE |
| /* denote that this file does not allow legacy hddLog */ |
| #define HDD_DISALLOW_LEGACY_HDDLOG 1 |
| |
| #include <wlan_hdd_includes.h> |
| #include <wlan_hdd_debugfs.h> |
| #include <wlan_hdd_wowl.h> |
| #include <cds_sched.h> |
| |
| #define MAX_USER_COMMAND_SIZE_WOWL_ENABLE 8 |
| #define MAX_USER_COMMAND_SIZE_WOWL_PATTERN 512 |
| #define MAX_USER_COMMAND_SIZE_FRAME 4096 |
| |
| /** |
| * __wcnss_wowenable_write() - wow_enable debugfs handler |
| * @file: debugfs file handle |
| * @buf: text being written to the debugfs |
| * @count: size of @buf |
| * @ppos: (unused) offset into the virtual file system |
| * |
| * Return: number of bytes processed |
| */ |
| static ssize_t __wcnss_wowenable_write(struct file *file, |
| const char __user *buf, size_t count, |
| loff_t *ppos) |
| { |
| hdd_adapter_t *pAdapter; |
| hdd_context_t *hdd_ctx; |
| char cmd[MAX_USER_COMMAND_SIZE_WOWL_ENABLE + 1]; |
| char *sptr, *token; |
| uint8_t wow_enable = 0; |
| uint8_t wow_mp = 0; |
| uint8_t wow_pbm = 0; |
| int ret; |
| |
| ENTER(); |
| |
| pAdapter = (hdd_adapter_t *)file->private_data; |
| if ((NULL == pAdapter) || (WLAN_HDD_ADAPTER_MAGIC != pAdapter->magic)) { |
| hdd_alert("Invalid adapter or adapter has invalid magic."); |
| |
| return -EINVAL; |
| } |
| |
| hdd_ctx = WLAN_HDD_GET_CTX(pAdapter); |
| ret = wlan_hdd_validate_context(hdd_ctx); |
| if (0 != ret) |
| return ret; |
| |
| |
| if (!sme_is_feature_supported_by_fw(WOW)) { |
| hdd_err("Wake-on-Wireless feature is not supported in firmware!"); |
| |
| return -EINVAL; |
| } |
| |
| if (count > MAX_USER_COMMAND_SIZE_WOWL_ENABLE) { |
| hdd_err("Command length is larger than %d bytes.", |
| MAX_USER_COMMAND_SIZE_WOWL_ENABLE); |
| |
| return -EINVAL; |
| } |
| |
| /* Get command from user */ |
| if (copy_from_user(cmd, buf, count)) |
| return -EFAULT; |
| cmd[count] = '\0'; |
| sptr = cmd; |
| |
| /* Get enable or disable wow */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| return -EINVAL; |
| if (kstrtou8(token, 0, &wow_enable)) |
| return -EINVAL; |
| |
| /* Disable wow */ |
| if (!wow_enable) { |
| if (!hdd_exit_wowl(pAdapter)) { |
| hdd_err("hdd_exit_wowl failed!"); |
| |
| return -EFAULT; |
| } |
| |
| return count; |
| } |
| |
| /* Get enable or disable magic packet mode */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| return -EINVAL; |
| if (kstrtou8(token, 0, &wow_mp)) |
| return -EINVAL; |
| if (wow_mp > 1) |
| wow_mp = 1; |
| |
| /* Get enable or disable pattern byte matching mode */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| return -EINVAL; |
| if (kstrtou8(token, 0, &wow_pbm)) |
| return -EINVAL; |
| if (wow_pbm > 1) |
| wow_pbm = 1; |
| |
| if (!hdd_enter_wowl(pAdapter, wow_mp, wow_pbm)) { |
| hdd_err("hdd_enter_wowl failed!"); |
| |
| return -EFAULT; |
| } |
| EXIT(); |
| return count; |
| } |
| |
| /** |
| * wcnss_wowenable_write() - SSR wrapper for wcnss_wowenable_write |
| * @file: file pointer |
| * @buf: buffer |
| * @count: count |
| * @ppos: position pointer |
| * |
| * Return: 0 on success, error number otherwise |
| */ |
| static ssize_t wcnss_wowenable_write(struct file *file, |
| const char __user *buf, |
| size_t count, loff_t *ppos) |
| { |
| ssize_t ret; |
| |
| cds_ssr_protect(__func__); |
| ret = __wcnss_wowenable_write(file, buf, count, ppos); |
| cds_ssr_unprotect(__func__); |
| |
| return ret; |
| } |
| |
| /** |
| * __wcnss_wowpattern_write() - wow_pattern debugfs handler |
| * @file: debugfs file handle |
| * @buf: text being written to the debugfs |
| * @count: size of @buf |
| * @ppos: (unused) offset into the virtual file system |
| * |
| * Return: number of bytes processed |
| */ |
| static ssize_t __wcnss_wowpattern_write(struct file *file, |
| const char __user *buf, size_t count, |
| loff_t *ppos) |
| { |
| hdd_adapter_t *pAdapter = (hdd_adapter_t *) file->private_data; |
| hdd_context_t *hdd_ctx; |
| char cmd[MAX_USER_COMMAND_SIZE_WOWL_PATTERN + 1]; |
| char *sptr, *token; |
| uint8_t pattern_idx = 0; |
| uint8_t pattern_offset = 0; |
| char *pattern_buf; |
| char *pattern_mask; |
| int ret; |
| |
| ENTER(); |
| |
| if ((NULL == pAdapter) || (WLAN_HDD_ADAPTER_MAGIC != pAdapter->magic)) { |
| hdd_alert("Invalid adapter or adapter has invalid magic."); |
| |
| return -EINVAL; |
| } |
| |
| hdd_ctx = WLAN_HDD_GET_CTX(pAdapter); |
| ret = wlan_hdd_validate_context(hdd_ctx); |
| if (0 != ret) |
| return ret; |
| |
| if (!sme_is_feature_supported_by_fw(WOW)) { |
| hdd_err("Wake-on-Wireless feature is not supported in firmware!"); |
| |
| return -EINVAL; |
| } |
| |
| if (count > MAX_USER_COMMAND_SIZE_WOWL_PATTERN) { |
| hdd_err("Command length is larger than %d bytes.", |
| MAX_USER_COMMAND_SIZE_WOWL_PATTERN); |
| |
| return -EINVAL; |
| } |
| |
| /* Get command from user */ |
| if (copy_from_user(cmd, buf, count)) |
| return -EFAULT; |
| cmd[count] = '\0'; |
| sptr = cmd; |
| |
| /* Get pattern idx */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| return -EINVAL; |
| |
| if (kstrtou8(token, 0, &pattern_idx)) |
| return -EINVAL; |
| |
| /* Get pattern offset */ |
| token = strsep(&sptr, " "); |
| |
| /* Delete pattern if no further argument */ |
| if (!token) { |
| hdd_del_wowl_ptrn_debugfs(pAdapter, pattern_idx); |
| |
| return count; |
| } |
| |
| if (kstrtou8(token, 0, &pattern_offset)) |
| return -EINVAL; |
| |
| /* Get pattern */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| return -EINVAL; |
| |
| pattern_buf = token; |
| |
| /* Get pattern mask */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| return -EINVAL; |
| |
| pattern_mask = token; |
| pattern_mask[strlen(pattern_mask) - 1] = '\0'; |
| |
| hdd_add_wowl_ptrn_debugfs(pAdapter, pattern_idx, pattern_offset, |
| pattern_buf, pattern_mask); |
| EXIT(); |
| return count; |
| } |
| |
| /** |
| * wcnss_wowpattern_write() - SSR wrapper for __wcnss_wowpattern_write |
| * @file: file pointer |
| * @buf: buffer |
| * @count: count |
| * @ppos: position pointer |
| * |
| * Return: 0 on success, error number otherwise |
| */ |
| static ssize_t wcnss_wowpattern_write(struct file *file, |
| const char __user *buf, |
| size_t count, loff_t *ppos) |
| { |
| ssize_t ret; |
| |
| cds_ssr_protect(__func__); |
| ret = __wcnss_wowpattern_write(file, buf, count, ppos); |
| cds_ssr_unprotect(__func__); |
| |
| return ret; |
| } |
| |
| /** |
| * wcnss_patterngen_write() - pattern_gen debugfs handler |
| * @file: debugfs file handle |
| * @buf: text being written to the debugfs |
| * @count: size of @buf |
| * @ppos: (unused) offset into the virtual file system |
| * |
| * Return: number of bytes processed |
| */ |
| static ssize_t __wcnss_patterngen_write(struct file *file, |
| const char __user *buf, size_t count, |
| loff_t *ppos) |
| { |
| hdd_adapter_t *pAdapter; |
| hdd_context_t *pHddCtx; |
| tSirAddPeriodicTxPtrn *addPeriodicTxPtrnParams; |
| tSirDelPeriodicTxPtrn *delPeriodicTxPtrnParams; |
| |
| char *cmd, *sptr, *token; |
| uint8_t pattern_idx = 0; |
| uint8_t pattern_duration = 0; |
| char *pattern_buf; |
| uint16_t pattern_len = 0; |
| uint16_t i = 0; |
| QDF_STATUS status; |
| int ret; |
| |
| ENTER(); |
| |
| pAdapter = (hdd_adapter_t *)file->private_data; |
| if ((NULL == pAdapter) || (WLAN_HDD_ADAPTER_MAGIC != pAdapter->magic)) { |
| hdd_alert("Invalid adapter or adapter has invalid magic."); |
| |
| return -EINVAL; |
| } |
| |
| pHddCtx = WLAN_HDD_GET_CTX(pAdapter); |
| ret = wlan_hdd_validate_context(pHddCtx); |
| if (0 != ret) |
| return ret; |
| |
| if (!sme_is_feature_supported_by_fw(WLAN_PERIODIC_TX_PTRN)) { |
| hdd_err("Periodic Tx Pattern Offload feature is not supported in firmware!"); |
| return -EINVAL; |
| } |
| |
| /* Get command from user */ |
| if (count <= MAX_USER_COMMAND_SIZE_FRAME) |
| cmd = qdf_mem_malloc(count + 1); |
| else { |
| hdd_err("Command length is larger than %d bytes.", |
| MAX_USER_COMMAND_SIZE_FRAME); |
| |
| return -EINVAL; |
| } |
| |
| if (!cmd) { |
| hdd_err("Memory allocation for cmd failed!"); |
| return -ENOMEM; |
| } |
| |
| if (copy_from_user(cmd, buf, count)) { |
| qdf_mem_free(cmd); |
| return -EFAULT; |
| } |
| cmd[count] = '\0'; |
| sptr = cmd; |
| |
| /* Get pattern idx */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| goto failure; |
| if (kstrtou8(token, 0, &pattern_idx)) |
| goto failure; |
| |
| if (pattern_idx > (MAXNUM_PERIODIC_TX_PTRNS - 1)) { |
| hdd_err("Pattern index %d is not in the range (0 ~ %d).", |
| pattern_idx, MAXNUM_PERIODIC_TX_PTRNS - 1); |
| |
| goto failure; |
| } |
| |
| /* Get pattern duration */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| goto failure; |
| if (kstrtou8(token, 0, &pattern_duration)) |
| goto failure; |
| |
| /* Delete pattern using index if duration is 0 */ |
| if (!pattern_duration) { |
| delPeriodicTxPtrnParams = |
| qdf_mem_malloc(sizeof(tSirDelPeriodicTxPtrn)); |
| if (!delPeriodicTxPtrnParams) { |
| hdd_err("Memory allocation failed!"); |
| qdf_mem_free(cmd); |
| return -ENOMEM; |
| } |
| delPeriodicTxPtrnParams->ucPtrnId = pattern_idx; |
| delPeriodicTxPtrnParams->ucPatternIdBitmap = 1 << pattern_idx; |
| qdf_copy_macaddr(&delPeriodicTxPtrnParams->mac_address, |
| &pAdapter->macAddressCurrent); |
| |
| /* Delete pattern */ |
| status = sme_del_periodic_tx_ptrn(pHddCtx->hHal, |
| delPeriodicTxPtrnParams); |
| if (QDF_STATUS_SUCCESS != status) { |
| hdd_err("sme_del_periodic_tx_ptrn() failed!"); |
| |
| qdf_mem_free(delPeriodicTxPtrnParams); |
| goto failure; |
| } |
| qdf_mem_free(cmd); |
| qdf_mem_free(delPeriodicTxPtrnParams); |
| return count; |
| } |
| |
| /* |
| * In SAP mode allow configuration without any connection check |
| * In STA mode check if it's in connected state before adding |
| * patterns |
| */ |
| hdd_info("device mode %d", pAdapter->device_mode); |
| if ((QDF_STA_MODE == pAdapter->device_mode) && |
| (!hdd_conn_is_connected(WLAN_HDD_GET_STATION_CTX_PTR(pAdapter)))) { |
| hdd_err("Not in Connected state!"); |
| goto failure; |
| } |
| |
| /* Get pattern */ |
| token = strsep(&sptr, " "); |
| if (!token) |
| goto failure; |
| |
| pattern_buf = token; |
| pattern_buf[strlen(pattern_buf) - 1] = '\0'; |
| pattern_len = strlen(pattern_buf); |
| |
| /* Since the pattern is a hex string, 2 characters represent 1 byte. */ |
| if (pattern_len % 2) { |
| hdd_err("Malformed pattern!"); |
| |
| goto failure; |
| } else |
| pattern_len >>= 1; |
| |
| if (pattern_len < 14 || pattern_len > PERIODIC_TX_PTRN_MAX_SIZE) { |
| hdd_err("Not an 802.3 frame!"); |
| |
| goto failure; |
| } |
| |
| addPeriodicTxPtrnParams = qdf_mem_malloc(sizeof(tSirAddPeriodicTxPtrn)); |
| if (!addPeriodicTxPtrnParams) { |
| hdd_err("Memory allocation failed!"); |
| qdf_mem_free(cmd); |
| return -ENOMEM; |
| } |
| |
| addPeriodicTxPtrnParams->ucPtrnId = pattern_idx; |
| addPeriodicTxPtrnParams->usPtrnIntervalMs = pattern_duration * 500; |
| addPeriodicTxPtrnParams->ucPtrnSize = pattern_len; |
| qdf_copy_macaddr(&addPeriodicTxPtrnParams->mac_address, |
| &pAdapter->macAddressCurrent); |
| |
| /* Extract the pattern */ |
| for (i = 0; i < addPeriodicTxPtrnParams->ucPtrnSize; i++) { |
| addPeriodicTxPtrnParams->ucPattern[i] = |
| (hex_to_bin(pattern_buf[0]) << 4) + |
| hex_to_bin(pattern_buf[1]); |
| |
| /* Skip to next byte */ |
| pattern_buf += 2; |
| } |
| |
| /* Add pattern */ |
| status = sme_add_periodic_tx_ptrn(pHddCtx->hHal, |
| addPeriodicTxPtrnParams); |
| if (QDF_STATUS_SUCCESS != status) { |
| hdd_err("sme_add_periodic_tx_ptrn() failed!"); |
| |
| qdf_mem_free(addPeriodicTxPtrnParams); |
| goto failure; |
| } |
| qdf_mem_free(cmd); |
| qdf_mem_free(addPeriodicTxPtrnParams); |
| EXIT(); |
| return count; |
| |
| failure: |
| hdd_err("Invalid input. Input format is: ptrn_idx duration pattern"); |
| qdf_mem_free(cmd); |
| return -EINVAL; |
| } |
| |
| /** |
| * wcnss_patterngen_write() - SSR wrapper for __wcnss_patterngen_write |
| * @file: file pointer |
| * @buf: buffer |
| * @count: count |
| * @ppos: position pointer |
| * |
| * Return: 0 on success, error number otherwise |
| */ |
| static ssize_t wcnss_patterngen_write(struct file *file, |
| const char __user *buf, |
| size_t count, loff_t *ppos) |
| { |
| ssize_t ret; |
| |
| cds_ssr_protect(__func__); |
| ret = __wcnss_patterngen_write(file, buf, count, ppos); |
| cds_ssr_unprotect(__func__); |
| |
| return ret; |
| } |
| |
| /** |
| * __wcnss_debugfs_open() - Generic debugfs open() handler |
| * @inode: inode of the debugfs file |
| * @file: file handle of the debugfs file |
| * |
| * Return: 0 |
| */ |
| static int __wcnss_debugfs_open(struct inode *inode, struct file *file) |
| { |
| hdd_adapter_t *adapter; |
| hdd_context_t *hdd_ctx; |
| int ret; |
| |
| ENTER(); |
| |
| if (inode->i_private) |
| file->private_data = inode->i_private; |
| |
| adapter = (hdd_adapter_t *)file->private_data; |
| if ((NULL == adapter) || (WLAN_HDD_ADAPTER_MAGIC != adapter->magic)) { |
| hdd_alert("Invalid adapter or adapter has invalid magic."); |
| return -EINVAL; |
| } |
| |
| hdd_ctx = WLAN_HDD_GET_CTX(adapter); |
| ret = wlan_hdd_validate_context(hdd_ctx); |
| if (0 != ret) |
| return ret; |
| EXIT(); |
| return 0; |
| } |
| |
| /** |
| * wcnss_debugfs_open() - SSR wrapper for __wcnss_debugfs_open |
| * @inode: inode pointer |
| * @file: file pointer |
| * |
| * Return: 0 on success, error number otherwise |
| */ |
| static int wcnss_debugfs_open(struct inode *inode, struct file *file) |
| { |
| int ret; |
| |
| cds_ssr_protect(__func__); |
| ret = __wcnss_debugfs_open(inode, file); |
| cds_ssr_unprotect(__func__); |
| |
| return ret; |
| } |
| |
| static const struct file_operations fops_wowenable = { |
| .write = wcnss_wowenable_write, |
| .open = wcnss_debugfs_open, |
| .owner = THIS_MODULE, |
| .llseek = default_llseek, |
| }; |
| |
| static const struct file_operations fops_wowpattern = { |
| .write = wcnss_wowpattern_write, |
| .open = wcnss_debugfs_open, |
| .owner = THIS_MODULE, |
| .llseek = default_llseek, |
| }; |
| |
| static const struct file_operations fops_patterngen = { |
| .write = wcnss_patterngen_write, |
| .open = wcnss_debugfs_open, |
| .owner = THIS_MODULE, |
| .llseek = default_llseek, |
| }; |
| |
| /** |
| * hdd_debugfs_init() - Initialize debugfs interface |
| * @adapter: interface adapter pointer |
| * |
| * Register support for the debugfs files supported by the driver. |
| * |
| * NB: The current implementation only supports debugfs operations |
| * on the primary interface, i.e. wlan0 |
| * |
| * Return: QDF_STATUS_SUCCESS if all files registered, |
| * QDF_STATUS_E_FAILURE on failure |
| */ |
| QDF_STATUS hdd_debugfs_init(hdd_adapter_t *adapter) |
| { |
| struct net_device *dev = adapter->dev; |
| adapter->debugfs_phy = debugfs_create_dir(dev->name, 0); |
| |
| if (NULL == adapter->debugfs_phy) |
| return QDF_STATUS_E_FAILURE; |
| |
| if (NULL == debugfs_create_file("wow_enable", S_IRUSR | S_IWUSR, |
| adapter->debugfs_phy, adapter, |
| &fops_wowenable)) |
| return QDF_STATUS_E_FAILURE; |
| |
| if (NULL == debugfs_create_file("wow_pattern", S_IRUSR | S_IWUSR, |
| adapter->debugfs_phy, adapter, |
| &fops_wowpattern)) |
| return QDF_STATUS_E_FAILURE; |
| |
| if (NULL == debugfs_create_file("pattern_gen", S_IRUSR | S_IWUSR, |
| adapter->debugfs_phy, adapter, |
| &fops_patterngen)) |
| return QDF_STATUS_E_FAILURE; |
| |
| return QDF_STATUS_SUCCESS; |
| } |
| |
| /** |
| * hdd_debugfs_exit() - Shutdown debugfs interface |
| * @adapter: interface adapter pointer |
| * |
| * Unregister support for the debugfs files supported by the driver. |
| * |
| * Return: None |
| */ |
| void hdd_debugfs_exit(hdd_adapter_t *adapter) |
| { |
| struct net_device *dev = adapter->dev; |
| |
| if (adapter->debugfs_phy) |
| debugfs_remove_recursive(adapter->debugfs_phy); |
| else |
| hdd_info("Interface %s has no debugfs entry", dev->name); |
| } |
| #endif /* #ifdef WLAN_OPEN_SOURCE */ |