185 lines
4.4 KiB
C
185 lines
4.4 KiB
C
![]() |
|
||
|
#include <linux/netdevice.h>
|
||
|
#include <linux/ethtool.h>
|
||
|
#include <linux/delay.h>
|
||
|
|
||
|
#include "host.h"
|
||
|
#include "sbi.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"
|
||
|
};
|
||
|
|
||
|
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_pr_debug(1, "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);
|
||
|
LEAVE();
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
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);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void libertas_ethtool_get_stats(struct net_device * dev,
|
||
|
struct ethtool_stats * stats, u64 * data)
|
||
|
{
|
||
|
wlan_private *priv = dev->priv;
|
||
|
|
||
|
ENTER();
|
||
|
|
||
|
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;
|
||
|
|
||
|
LEAVE();
|
||
|
}
|
||
|
|
||
|
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;
|
||
|
|
||
|
ENTER();
|
||
|
/* 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) {
|
||
|
LEAVE();
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
priv->mstats.fwd_drop_rbt = mesh_access.data[0];
|
||
|
priv->mstats.fwd_drop_ttl = mesh_access.data[1];
|
||
|
priv->mstats.fwd_drop_noroute = mesh_access.data[2];
|
||
|
priv->mstats.fwd_drop_nobuf = mesh_access.data[3];
|
||
|
priv->mstats.fwd_unicast_cnt = mesh_access.data[4];
|
||
|
priv->mstats.fwd_bcast_cnt = mesh_access.data[5];
|
||
|
priv->mstats.drop_blind = mesh_access.data[6];
|
||
|
|
||
|
LEAVE();
|
||
|
return MESH_STATS_NUM;
|
||
|
}
|
||
|
|
||
|
static void libertas_ethtool_get_strings (struct net_device * dev,
|
||
|
u32 stringset,
|
||
|
u8 * s)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
ENTER();
|
||
|
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;
|
||
|
}
|
||
|
LEAVE();
|
||
|
}
|
||
|
|
||
|
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,
|
||
|
};
|
||
|
|