| /* |
| * Marvell Wireless LAN device driver: debugfs |
| * |
| * Copyright (C) 2011, Marvell International Ltd. |
| * |
| * This software file (the "File") is distributed by Marvell International |
| * Ltd. under the terms of the GNU General Public License Version 2, June 1991 |
| * (the "License"). You may use, redistribute and/or modify this File in |
| * accordance with the terms and conditions of the License, a copy of which |
| * is available by writing to the Free Software Foundation, Inc., |
| * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the |
| * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt. |
| * |
| * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE |
| * ARE EXPRESSLY DISCLAIMED. The License provides additional details about |
| * this warranty disclaimer. |
| */ |
| |
| #include <linux/debugfs.h> |
| |
| #include "main.h" |
| #include "11n.h" |
| |
| |
| static struct dentry *mwifiex_dfs_dir; |
| |
| static char *bss_modes[] = { |
| "Unknown", |
| "Ad-hoc", |
| "Managed", |
| "Auto" |
| }; |
| |
| /* size/addr for mwifiex_debug_info */ |
| #define item_size(n) (FIELD_SIZEOF(struct mwifiex_debug_info, n)) |
| #define item_addr(n) (offsetof(struct mwifiex_debug_info, n)) |
| |
| /* size/addr for struct mwifiex_adapter */ |
| #define adapter_item_size(n) (FIELD_SIZEOF(struct mwifiex_adapter, n)) |
| #define adapter_item_addr(n) (offsetof(struct mwifiex_adapter, n)) |
| |
| struct mwifiex_debug_data { |
| char name[32]; /* variable/array name */ |
| u32 size; /* size of the variable/array */ |
| size_t addr; /* address of the variable/array */ |
| int num; /* number of variables in an array */ |
| }; |
| |
| static struct mwifiex_debug_data items[] = { |
| {"int_counter", item_size(int_counter), |
| item_addr(int_counter), 1}, |
| {"wmm_ac_vo", item_size(packets_out[WMM_AC_VO]), |
| item_addr(packets_out[WMM_AC_VO]), 1}, |
| {"wmm_ac_vi", item_size(packets_out[WMM_AC_VI]), |
| item_addr(packets_out[WMM_AC_VI]), 1}, |
| {"wmm_ac_be", item_size(packets_out[WMM_AC_BE]), |
| item_addr(packets_out[WMM_AC_BE]), 1}, |
| {"wmm_ac_bk", item_size(packets_out[WMM_AC_BK]), |
| item_addr(packets_out[WMM_AC_BK]), 1}, |
| {"max_tx_buf_size", item_size(max_tx_buf_size), |
| item_addr(max_tx_buf_size), 1}, |
| {"tx_buf_size", item_size(tx_buf_size), |
| item_addr(tx_buf_size), 1}, |
| {"curr_tx_buf_size", item_size(curr_tx_buf_size), |
| item_addr(curr_tx_buf_size), 1}, |
| {"ps_mode", item_size(ps_mode), |
| item_addr(ps_mode), 1}, |
| {"ps_state", item_size(ps_state), |
| item_addr(ps_state), 1}, |
| {"is_deep_sleep", item_size(is_deep_sleep), |
| item_addr(is_deep_sleep), 1}, |
| {"wakeup_dev_req", item_size(pm_wakeup_card_req), |
| item_addr(pm_wakeup_card_req), 1}, |
| {"wakeup_tries", item_size(pm_wakeup_fw_try), |
| item_addr(pm_wakeup_fw_try), 1}, |
| {"hs_configured", item_size(is_hs_configured), |
| item_addr(is_hs_configured), 1}, |
| {"hs_activated", item_size(hs_activated), |
| item_addr(hs_activated), 1}, |
| {"num_tx_timeout", item_size(num_tx_timeout), |
| item_addr(num_tx_timeout), 1}, |
| {"num_cmd_timeout", item_size(num_cmd_timeout), |
| item_addr(num_cmd_timeout), 1}, |
| {"timeout_cmd_id", item_size(timeout_cmd_id), |
| item_addr(timeout_cmd_id), 1}, |
| {"timeout_cmd_act", item_size(timeout_cmd_act), |
| item_addr(timeout_cmd_act), 1}, |
| {"last_cmd_id", item_size(last_cmd_id), |
| item_addr(last_cmd_id), DBG_CMD_NUM}, |
| {"last_cmd_act", item_size(last_cmd_act), |
| item_addr(last_cmd_act), DBG_CMD_NUM}, |
| {"last_cmd_index", item_size(last_cmd_index), |
| item_addr(last_cmd_index), 1}, |
| {"last_cmd_resp_id", item_size(last_cmd_resp_id), |
| item_addr(last_cmd_resp_id), DBG_CMD_NUM}, |
| {"last_cmd_resp_index", item_size(last_cmd_resp_index), |
| item_addr(last_cmd_resp_index), 1}, |
| {"last_event", item_size(last_event), |
| item_addr(last_event), DBG_CMD_NUM}, |
| {"last_event_index", item_size(last_event_index), |
| item_addr(last_event_index), 1}, |
| {"num_cmd_h2c_fail", item_size(num_cmd_host_to_card_failure), |
| item_addr(num_cmd_host_to_card_failure), 1}, |
| {"num_cmd_sleep_cfm_fail", |
| item_size(num_cmd_sleep_cfm_host_to_card_failure), |
| item_addr(num_cmd_sleep_cfm_host_to_card_failure), 1}, |
| {"num_tx_h2c_fail", item_size(num_tx_host_to_card_failure), |
| item_addr(num_tx_host_to_card_failure), 1}, |
| {"num_evt_deauth", item_size(num_event_deauth), |
| item_addr(num_event_deauth), 1}, |
| {"num_evt_disassoc", item_size(num_event_disassoc), |
| item_addr(num_event_disassoc), 1}, |
| {"num_evt_link_lost", item_size(num_event_link_lost), |
| item_addr(num_event_link_lost), 1}, |
| {"num_cmd_deauth", item_size(num_cmd_deauth), |
| item_addr(num_cmd_deauth), 1}, |
| {"num_cmd_assoc_ok", item_size(num_cmd_assoc_success), |
| item_addr(num_cmd_assoc_success), 1}, |
| {"num_cmd_assoc_fail", item_size(num_cmd_assoc_failure), |
| item_addr(num_cmd_assoc_failure), 1}, |
| {"cmd_sent", item_size(cmd_sent), |
| item_addr(cmd_sent), 1}, |
| {"data_sent", item_size(data_sent), |
| item_addr(data_sent), 1}, |
| {"cmd_resp_received", item_size(cmd_resp_received), |
| item_addr(cmd_resp_received), 1}, |
| {"event_received", item_size(event_received), |
| item_addr(event_received), 1}, |
| |
| /* variables defined in struct mwifiex_adapter */ |
| {"cmd_pending", adapter_item_size(cmd_pending), |
| adapter_item_addr(cmd_pending), 1}, |
| {"tx_pending", adapter_item_size(tx_pending), |
| adapter_item_addr(tx_pending), 1}, |
| {"rx_pending", adapter_item_size(rx_pending), |
| adapter_item_addr(rx_pending), 1}, |
| }; |
| |
| static int num_of_items = ARRAY_SIZE(items); |
| |
| /* |
| * Generic proc file open handler. |
| * |
| * This function is called every time a file is accessed for read or write. |
| */ |
| static int |
| mwifiex_open_generic(struct inode *inode, struct file *file) |
| { |
| file->private_data = inode->i_private; |
| return 0; |
| } |
| |
| /* |
| * Proc info file read handler. |
| * |
| * This function is called when the 'info' file is opened for reading. |
| * It prints the following driver related information - |
| * - Driver name |
| * - Driver version |
| * - Driver extended version |
| * - Interface name |
| * - BSS mode |
| * - Media state (connected or disconnected) |
| * - MAC address |
| * - Total number of Tx bytes |
| * - Total number of Rx bytes |
| * - Total number of Tx packets |
| * - Total number of Rx packets |
| * - Total number of dropped Tx packets |
| * - Total number of dropped Rx packets |
| * - Total number of corrupted Tx packets |
| * - Total number of corrupted Rx packets |
| * - Carrier status (on or off) |
| * - Tx queue status (started or stopped) |
| * |
| * For STA mode drivers, it also prints the following extra - |
| * - ESSID |
| * - BSSID |
| * - Channel |
| * - Region code |
| * - Multicast count |
| * - Multicast addresses |
| */ |
| static ssize_t |
| mwifiex_info_read(struct file *file, char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| struct mwifiex_private *priv = |
| (struct mwifiex_private *) file->private_data; |
| struct net_device *netdev = priv->netdev; |
| struct netdev_hw_addr *ha; |
| unsigned long page = get_zeroed_page(GFP_KERNEL); |
| char *p = (char *) page, fmt[64]; |
| struct mwifiex_bss_info info; |
| ssize_t ret; |
| int i = 0; |
| |
| if (!p) |
| return -ENOMEM; |
| |
| memset(&info, 0, sizeof(info)); |
| ret = mwifiex_get_bss_info(priv, &info); |
| if (ret) |
| goto free_and_exit; |
| |
| mwifiex_drv_get_driver_version(priv->adapter, fmt, sizeof(fmt) - 1); |
| |
| if (!priv->version_str[0]) |
| mwifiex_get_ver_ext(priv); |
| |
| p += sprintf(p, "driver_name = " "\"mwifiex\"\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); |
| 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=\"%02x:%02x:%02x:%02x:%02x:%02x\"\n", |
| netdev->dev_addr[0], netdev->dev_addr[1], |
| netdev->dev_addr[2], netdev->dev_addr[3], |
| netdev->dev_addr[4], netdev->dev_addr[5]); |
| |
| if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) { |
| p += sprintf(p, "multicast_count=\"%d\"\n", |
| netdev_mc_count(netdev)); |
| p += sprintf(p, "essid=\"%s\"\n", info.ssid.ssid); |
| p += sprintf(p, "bssid=\"%02x:%02x:%02x:%02x:%02x:%02x\"\n", |
| info.bssid[0], info.bssid[1], |
| info.bssid[2], info.bssid[3], |
| info.bssid[4], info.bssid[5]); |
| p += sprintf(p, "channel=\"%d\"\n", (int) info.bss_chan); |
| p += sprintf(p, "region_code = \"%02x\"\n", info.region_code); |
| |
| netdev_for_each_mc_addr(ha, netdev) |
| p += sprintf(p, "multicast_address[%d]=" |
| "\"%02x:%02x:%02x:%02x:%02x:%02x\"\n", i++, |
| ha->addr[0], ha->addr[1], |
| ha->addr[2], ha->addr[3], |
| ha->addr[4], ha->addr[5]); |
| } |
| |
| 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 %s\n", ((netif_queue_stopped(priv->netdev)) |
| ? "stopped" : "started")); |
| |
| ret = simple_read_from_buffer(ubuf, count, ppos, (char *) page, |
| (unsigned long) p - page); |
| |
| free_and_exit: |
| free_page(page); |
| return ret; |
| } |
| |
| /* |
| * Proc getlog file read handler. |
| * |
| * This function is called when the 'getlog' file is opened for reading |
| * It prints the following log information - |
| * - Number of multicast Tx frames |
| * - Number of failed packets |
| * - Number of Tx retries |
| * - Number of multicast Tx retries |
| * - Number of duplicate frames |
| * - Number of RTS successes |
| * - Number of RTS failures |
| * - Number of ACK failures |
| * - Number of fragmented Rx frames |
| * - Number of multicast Rx frames |
| * - Number of FCS errors |
| * - Number of Tx frames |
| * - WEP ICV error counts |
| */ |
| static ssize_t |
| mwifiex_getlog_read(struct file *file, char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| struct mwifiex_private *priv = |
| (struct mwifiex_private *) file->private_data; |
| unsigned long page = get_zeroed_page(GFP_KERNEL); |
| char *p = (char *) page; |
| ssize_t ret; |
| struct mwifiex_ds_get_stats stats; |
| |
| if (!p) |
| return -ENOMEM; |
| |
| memset(&stats, 0, sizeof(stats)); |
| ret = mwifiex_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", |
| 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]); |
| |
| |
| ret = simple_read_from_buffer(ubuf, count, ppos, (char *) page, |
| (unsigned long) p - page); |
| |
| free_and_exit: |
| free_page(page); |
| return ret; |
| } |
| |
| static struct mwifiex_debug_info info; |
| |
| /* |
| * Proc debug file read handler. |
| * |
| * This function is called when the 'debug' file is opened for reading |
| * It prints the following log information - |
| * - Interrupt count |
| * - WMM AC VO packets count |
| * - WMM AC VI packets count |
| * - WMM AC BE packets count |
| * - WMM AC BK packets count |
| * - Maximum Tx buffer size |
| * - Tx buffer size |
| * - Current Tx buffer size |
| * - Power Save mode |
| * - Power Save state |
| * - Deep Sleep status |
| * - Device wakeup required status |
| * - Number of wakeup tries |
| * - Host Sleep configured status |
| * - Host Sleep activated status |
| * - Number of Tx timeouts |
| * - Number of command timeouts |
| * - Last timed out command ID |
| * - Last timed out command action |
| * - Last command ID |
| * - Last command action |
| * - Last command index |
| * - Last command response ID |
| * - Last command response index |
| * - Last event |
| * - Last event index |
| * - Number of host to card command failures |
| * - Number of sleep confirm command failures |
| * - Number of host to card data failure |
| * - Number of deauthentication events |
| * - Number of disassociation events |
| * - Number of link lost events |
| * - Number of deauthentication commands |
| * - Number of association success commands |
| * - Number of association failure commands |
| * - Number of commands sent |
| * - Number of data packets sent |
| * - Number of command responses received |
| * - Number of events received |
| * - Tx BA stream table (TID, RA) |
| * - Rx reorder table (TID, TA, Start window, Window size, Buffer) |
| */ |
| static ssize_t |
| mwifiex_debug_read(struct file *file, char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| struct mwifiex_private *priv = |
| (struct mwifiex_private *) file->private_data; |
| struct mwifiex_debug_data *d = &items[0]; |
| unsigned long page = get_zeroed_page(GFP_KERNEL); |
| char *p = (char *) page; |
| ssize_t ret; |
| size_t size, addr; |
| long val; |
| int i, j; |
| |
| if (!p) |
| return -ENOMEM; |
| |
| ret = mwifiex_get_debug_info(priv, &info); |
| if (ret) |
| goto free_and_exit; |
| |
| for (i = 0; i < num_of_items; i++) { |
| p += sprintf(p, "%s=", d[i].name); |
| |
| size = d[i].size / d[i].num; |
| |
| if (i < (num_of_items - 3)) |
| addr = d[i].addr + (size_t) &info; |
| else /* The last 3 items are struct mwifiex_adapter variables */ |
| addr = d[i].addr + (size_t) priv->adapter; |
| |
| for (j = 0; j < d[i].num; j++) { |
| switch (size) { |
| case 1: |
| val = *((u8 *) addr); |
| break; |
| case 2: |
| val = *((u16 *) addr); |
| break; |
| case 4: |
| val = *((u32 *) addr); |
| break; |
| case 8: |
| val = *((long long *) addr); |
| break; |
| default: |
| val = -1; |
| break; |
| } |
| |
| p += sprintf(p, "%#lx ", val); |
| addr += size; |
| } |
| |
| p += sprintf(p, "\n"); |
| } |
| |
| if (info.tx_tbl_num) { |
| p += sprintf(p, "Tx BA stream table:\n"); |
| for (i = 0; i < info.tx_tbl_num; i++) |
| p += sprintf(p, "tid = %d, " |
| "ra = %02x:%02x:%02x:%02x:%02x:%02x\n", |
| info.tx_tbl[i].tid, info.tx_tbl[i].ra[0], |
| info.tx_tbl[i].ra[1], info.tx_tbl[i].ra[2], |
| info.tx_tbl[i].ra[3], info.tx_tbl[i].ra[4], |
| info.tx_tbl[i].ra[5]); |
| } |
| |
| if (info.rx_tbl_num) { |
| p += sprintf(p, "Rx reorder table:\n"); |
| for (i = 0; i < info.rx_tbl_num; i++) { |
| |
| p += sprintf(p, "tid = %d, " |
| "ta = %02x:%02x:%02x:%02x:%02x:%02x, " |
| "start_win = %d, " |
| "win_size = %d, buffer: ", |
| info.rx_tbl[i].tid, |
| info.rx_tbl[i].ta[0], info.rx_tbl[i].ta[1], |
| info.rx_tbl[i].ta[2], info.rx_tbl[i].ta[3], |
| info.rx_tbl[i].ta[4], info.rx_tbl[i].ta[5], |
| info.rx_tbl[i].start_win, |
| info.rx_tbl[i].win_size); |
| |
| for (j = 0; j < info.rx_tbl[i].win_size; j++) |
| p += sprintf(p, "%c ", |
| info.rx_tbl[i].buffer[j] ? |
| '1' : '0'); |
| |
| 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; |
| } |
| |
| static u32 saved_reg_type, saved_reg_offset, saved_reg_value; |
| |
| /* |
| * Proc regrdwr file write handler. |
| * |
| * This function is called when the 'regrdwr' file is opened for writing |
| * |
| * This function can be used to write to a register. |
| */ |
| static ssize_t |
| mwifiex_regrdwr_write(struct file *file, |
| const char __user *ubuf, size_t count, loff_t *ppos) |
| { |
| unsigned long addr = get_zeroed_page(GFP_KERNEL); |
| char *buf = (char *) addr; |
| size_t buf_size = min(count, (size_t) (PAGE_SIZE - 1)); |
| int ret; |
| u32 reg_type = 0, reg_offset = 0, reg_value = UINT_MAX; |
| |
| if (!buf) |
| return -ENOMEM; |
| |
| |
| if (copy_from_user(buf, ubuf, buf_size)) { |
| ret = -EFAULT; |
| goto done; |
| } |
| |
| sscanf(buf, "%u %x %x", ®_type, ®_offset, ®_value); |
| |
| 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: |
| free_page(addr); |
| return ret; |
| } |
| |
| /* |
| * Proc regrdwr file read handler. |
| * |
| * This function is called when the 'regrdwr' file is opened for reading |
| * |
| * This function can be used to read from a register. |
| */ |
| static ssize_t |
| mwifiex_regrdwr_read(struct file *file, char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| struct mwifiex_private *priv = |
| (struct mwifiex_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 = mwifiex_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 = mwifiex_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; |
| } |
| |
| static u32 saved_offset = -1, saved_bytes = -1; |
| |
| /* |
| * Proc rdeeprom file write handler. |
| * |
| * This function is called when the 'rdeeprom' file is opened for writing |
| * |
| * This function can be used to write to a RDEEPROM location. |
| */ |
| static ssize_t |
| mwifiex_rdeeprom_write(struct file *file, |
| const char __user *ubuf, size_t count, loff_t *ppos) |
| { |
| unsigned long addr = get_zeroed_page(GFP_KERNEL); |
| char *buf = (char *) addr; |
| size_t buf_size = min(count, (size_t) (PAGE_SIZE - 1)); |
| int ret = 0; |
| int offset = -1, bytes = -1; |
| |
| if (!buf) |
| return -ENOMEM; |
| |
| |
| if (copy_from_user(buf, ubuf, buf_size)) { |
| ret = -EFAULT; |
| goto done; |
| } |
| |
| sscanf(buf, "%d %d", &offset, &bytes); |
| |
| if (offset == -1 || bytes == -1) { |
| ret = -EINVAL; |
| goto done; |
| } else { |
| saved_offset = offset; |
| saved_bytes = bytes; |
| ret = count; |
| } |
| done: |
| free_page(addr); |
| return ret; |
| } |
| |
| /* |
| * Proc rdeeprom read write handler. |
| * |
| * This function is called when the 'rdeeprom' file is opened for reading |
| * |
| * This function can be used to read from a RDEEPROM location. |
| */ |
| static ssize_t |
| mwifiex_rdeeprom_read(struct file *file, char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| struct mwifiex_private *priv = |
| (struct mwifiex_private *) file->private_data; |
| unsigned long addr = get_zeroed_page(GFP_KERNEL); |
| char *buf = (char *) addr; |
| int pos = 0, ret = 0, 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 = mwifiex_eeprom_read(priv, (u16) saved_offset, |
| (u16) saved_bytes, value); |
| if (ret) { |
| ret = -EINVAL; |
| goto done; |
| } |
| |
| pos += snprintf(buf, PAGE_SIZE, "%d %d ", saved_offset, saved_bytes); |
| |
| for (i = 0; i < saved_bytes; i++) |
| pos += snprintf(buf + strlen(buf), PAGE_SIZE, "%d ", value[i]); |
| |
| ret = simple_read_from_buffer(ubuf, count, ppos, buf, pos); |
| |
| done: |
| free_page(addr); |
| return ret; |
| } |
| |
| |
| #define MWIFIEX_DFS_ADD_FILE(name) do { \ |
| if (!debugfs_create_file(#name, 0644, priv->dfs_dev_dir, \ |
| priv, &mwifiex_dfs_##name##_fops)) \ |
| return; \ |
| } while (0); |
| |
| #define MWIFIEX_DFS_FILE_OPS(name) \ |
| static const struct file_operations mwifiex_dfs_##name##_fops = { \ |
| .read = mwifiex_##name##_read, \ |
| .write = mwifiex_##name##_write, \ |
| .open = mwifiex_open_generic, \ |
| }; |
| |
| #define MWIFIEX_DFS_FILE_READ_OPS(name) \ |
| static const struct file_operations mwifiex_dfs_##name##_fops = { \ |
| .read = mwifiex_##name##_read, \ |
| .open = mwifiex_open_generic, \ |
| }; |
| |
| #define MWIFIEX_DFS_FILE_WRITE_OPS(name) \ |
| static const struct file_operations mwifiex_dfs_##name##_fops = { \ |
| .write = mwifiex_##name##_write, \ |
| .open = mwifiex_open_generic, \ |
| }; |
| |
| |
| MWIFIEX_DFS_FILE_READ_OPS(info); |
| MWIFIEX_DFS_FILE_READ_OPS(debug); |
| MWIFIEX_DFS_FILE_READ_OPS(getlog); |
| MWIFIEX_DFS_FILE_OPS(regrdwr); |
| MWIFIEX_DFS_FILE_OPS(rdeeprom); |
| |
| /* |
| * This function creates the debug FS directory structure and the files. |
| */ |
| void |
| mwifiex_dev_debugfs_init(struct mwifiex_private *priv) |
| { |
| if (!mwifiex_dfs_dir || !priv) |
| return; |
| |
| priv->dfs_dev_dir = debugfs_create_dir(priv->netdev->name, |
| mwifiex_dfs_dir); |
| |
| if (!priv->dfs_dev_dir) |
| return; |
| |
| MWIFIEX_DFS_ADD_FILE(info); |
| MWIFIEX_DFS_ADD_FILE(debug); |
| MWIFIEX_DFS_ADD_FILE(getlog); |
| MWIFIEX_DFS_ADD_FILE(regrdwr); |
| MWIFIEX_DFS_ADD_FILE(rdeeprom); |
| } |
| |
| /* |
| * This function removes the debug FS directory structure and the files. |
| */ |
| void |
| mwifiex_dev_debugfs_remove(struct mwifiex_private *priv) |
| { |
| if (!priv) |
| return; |
| |
| debugfs_remove_recursive(priv->dfs_dev_dir); |
| } |
| |
| /* |
| * This function creates the top level proc directory. |
| */ |
| void |
| mwifiex_debugfs_init(void) |
| { |
| if (!mwifiex_dfs_dir) |
| mwifiex_dfs_dir = debugfs_create_dir("mwifiex", NULL); |
| } |
| |
| /* |
| * This function removes the top level proc directory. |
| */ |
| void |
| mwifiex_debugfs_remove(void) |
| { |
| if (mwifiex_dfs_dir) |
| debugfs_remove(mwifiex_dfs_dir); |
| } |