| #include <linux/netdevice.h> |
| #include <linux/ethtool.h> |
| #include <linux/delay.h> |
| |
| #include "host.h" |
| #include "decl.h" |
| #include "defs.h" |
| #include "dev.h" |
| #include "join.h" |
| #include "wext.h" |
| static const char * mesh_stat_strings[]= { |
| "drop_duplicate_bcast", |
| "drop_ttl_zero", |
| "drop_no_fwd_route", |
| "drop_no_buffers", |
| "fwded_unicast_cnt", |
| "fwded_bcast_cnt", |
| "drop_blind_table", |
| "tx_failed_cnt" |
| }; |
| |
| static void libertas_ethtool_get_drvinfo(struct net_device *dev, |
| struct ethtool_drvinfo *info) |
| { |
| wlan_private *priv = (wlan_private *) dev->priv; |
| char fwver[32]; |
| |
| libertas_get_fwversion(priv->adapter, fwver, sizeof(fwver) - 1); |
| |
| strcpy(info->driver, "libertas"); |
| strcpy(info->version, libertas_driver_version); |
| strcpy(info->fw_version, fwver); |
| } |
| |
| /* All 8388 parts have 16KiB EEPROM size at the time of writing. |
| * In case that changes this needs fixing. |
| */ |
| #define LIBERTAS_EEPROM_LEN 16384 |
| |
| static int libertas_ethtool_get_eeprom_len(struct net_device *dev) |
| { |
| return LIBERTAS_EEPROM_LEN; |
| } |
| |
| static int libertas_ethtool_get_eeprom(struct net_device *dev, |
| struct ethtool_eeprom *eeprom, u8 * bytes) |
| { |
| wlan_private *priv = (wlan_private *) dev->priv; |
| wlan_adapter *adapter = priv->adapter; |
| struct wlan_ioctl_regrdwr regctrl; |
| char *ptr; |
| int ret; |
| |
| regctrl.action = 0; |
| regctrl.offset = eeprom->offset; |
| regctrl.NOB = eeprom->len; |
| |
| if (eeprom->offset + eeprom->len > LIBERTAS_EEPROM_LEN) |
| return -EINVAL; |
| |
| // mutex_lock(&priv->mutex); |
| |
| adapter->prdeeprom = |
| (char *)kmalloc(eeprom->len+sizeof(regctrl), GFP_KERNEL); |
| if (!adapter->prdeeprom) |
| return -ENOMEM; |
| memcpy(adapter->prdeeprom, ®ctrl, sizeof(regctrl)); |
| |
| /* +14 is for action, offset, and NOB in |
| * response */ |
| lbs_deb_ethtool("action:%d offset: %x NOB: %02x\n", |
| regctrl.action, regctrl.offset, regctrl.NOB); |
| |
| ret = libertas_prepare_and_send_command(priv, |
| CMD_802_11_EEPROM_ACCESS, |
| regctrl.action, |
| CMD_OPTION_WAITFORRSP, 0, |
| ®ctrl); |
| |
| if (ret) { |
| if (adapter->prdeeprom) |
| kfree(adapter->prdeeprom); |
| goto done; |
| } |
| |
| mdelay(10); |
| |
| ptr = (char *)adapter->prdeeprom; |
| |
| /* skip the command header, but include the "value" u32 variable */ |
| ptr = ptr + sizeof(struct wlan_ioctl_regrdwr) - 4; |
| |
| /* |
| * Return the result back to the user |
| */ |
| memcpy(bytes, ptr, eeprom->len); |
| |
| if (adapter->prdeeprom) |
| kfree(adapter->prdeeprom); |
| // mutex_unlock(&priv->mutex); |
| |
| ret = 0; |
| |
| done: |
| lbs_deb_enter_args(LBS_DEB_ETHTOOL, "ret %d", ret); |
| return ret; |
| } |
| |
| static void libertas_ethtool_get_stats(struct net_device * dev, |
| struct ethtool_stats * stats, u64 * data) |
| { |
| wlan_private *priv = dev->priv; |
| |
| lbs_deb_enter(LBS_DEB_ETHTOOL); |
| |
| stats->cmd = ETHTOOL_GSTATS; |
| BUG_ON(stats->n_stats != MESH_STATS_NUM); |
| |
| data[0] = priv->mstats.fwd_drop_rbt; |
| data[1] = priv->mstats.fwd_drop_ttl; |
| data[2] = priv->mstats.fwd_drop_noroute; |
| data[3] = priv->mstats.fwd_drop_nobuf; |
| data[4] = priv->mstats.fwd_unicast_cnt; |
| data[5] = priv->mstats.fwd_bcast_cnt; |
| data[6] = priv->mstats.drop_blind; |
| data[7] = priv->mstats.tx_failed_cnt; |
| |
| lbs_deb_enter(LBS_DEB_ETHTOOL); |
| } |
| |
| static int libertas_ethtool_get_stats_count(struct net_device * dev) |
| { |
| int ret; |
| wlan_private *priv = dev->priv; |
| struct cmd_ds_mesh_access mesh_access; |
| |
| lbs_deb_enter(LBS_DEB_ETHTOOL); |
| |
| /* Get Mesh Statistics */ |
| ret = libertas_prepare_and_send_command(priv, |
| CMD_MESH_ACCESS, CMD_ACT_MESH_GET_STATS, |
| CMD_OPTION_WAITFORRSP, 0, &mesh_access); |
| |
| if (ret) { |
| ret = 0; |
| goto done; |
| } |
| |
| priv->mstats.fwd_drop_rbt = le32_to_cpu(mesh_access.data[0]); |
| priv->mstats.fwd_drop_ttl = le32_to_cpu(mesh_access.data[1]); |
| priv->mstats.fwd_drop_noroute = le32_to_cpu(mesh_access.data[2]); |
| priv->mstats.fwd_drop_nobuf = le32_to_cpu(mesh_access.data[3]); |
| priv->mstats.fwd_unicast_cnt = le32_to_cpu(mesh_access.data[4]); |
| priv->mstats.fwd_bcast_cnt = le32_to_cpu(mesh_access.data[5]); |
| priv->mstats.drop_blind = le32_to_cpu(mesh_access.data[6]); |
| priv->mstats.tx_failed_cnt = le32_to_cpu(mesh_access.data[7]); |
| |
| ret = MESH_STATS_NUM; |
| |
| done: |
| lbs_deb_enter_args(LBS_DEB_ETHTOOL, "ret %d", ret); |
| return ret; |
| } |
| |
| static void libertas_ethtool_get_strings (struct net_device * dev, |
| u32 stringset, |
| u8 * s) |
| { |
| int i; |
| |
| lbs_deb_enter(LBS_DEB_ETHTOOL); |
| |
| switch (stringset) { |
| case ETH_SS_STATS: |
| for (i=0; i < MESH_STATS_NUM; i++) { |
| memcpy(s + i * ETH_GSTRING_LEN, |
| mesh_stat_strings[i], |
| ETH_GSTRING_LEN); |
| } |
| break; |
| } |
| lbs_deb_enter(LBS_DEB_ETHTOOL); |
| } |
| |
| struct ethtool_ops libertas_ethtool_ops = { |
| .get_drvinfo = libertas_ethtool_get_drvinfo, |
| .get_eeprom = libertas_ethtool_get_eeprom, |
| .get_eeprom_len = libertas_ethtool_get_eeprom_len, |
| .get_stats_count = libertas_ethtool_get_stats_count, |
| .get_ethtool_stats = libertas_ethtool_get_stats, |
| .get_strings = libertas_ethtool_get_strings, |
| }; |
| |