Re: [PATCH v2] drivers/net/usb/asix: resync from vendor's copy
From: Mark Lord
Date: Wed Nov 09 2011 - 12:43:11 EST
On 11-11-09 12:31 PM, Mark Lord wrote:
> Second pass (for review) at updating the in-kernel asix usb/network driver
> from the v4.1.0 vendor GPL version of the driver, obtained from here:
>
> http://www.asix.com.tw/download.php?sub=searchresult&PItemID=84&download=driver
>
> The original vendor copy used a local "axusbnet" middleware (rather than "usbnet").
> I've converted it back to using "usbnet", made a ton of cosmetic changes
> to get it to pass checkpatch.pl, and removed a small amount of code duplication.
>
> The tx/rx checksum code has been updated per Ben's comments,
> and the duplicated MII_* definitions have been removed.
> I've changed the version string to be "4.1.0-kernel",
> to reflect the vendor's code version while also distinguishing
> this port from the original vendor code.
>
> It can use more work going forward, but it is important to get it upstream
> sooner than later -- the current in-kernel driver fails with many devices,
> both old and new. This updated version works with everything I have available
> to test with, and also handles suspend / resume (unlike the in-kernel one).
>
> Signed-off-by: Mark Lord <mlord@xxxxxxxxx>
> ---
> Note that the vendor now has a v4.2.0 version available,
> but for now I'm concentrating on the original v4.1.0 code.
>
> After review/discussion of this patch, I will update for Linux-3.2-rc
> and resubmit for inclusion in the eventual linux-3.3 kernel.
..
And again, for ease of reviewing, the entire patched asix.c file is here:
/*
* ASIX AX8817X based USB 2.0 Ethernet Devices
* Copyright (C) 2003-2006 David Hollis <dhollis@xxxxxxxxxxxxxx>
* Copyright (C) 2005 Phil Chang <pchang23@xxxxxxxxxxxxx>
* Copyright (C) 2006 James Painter <jamie.painter@xxxxxxxxx>
* Copyright (c) 2002-2003 TiVo Inc.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
#include <linux/module.h>
#include <linux/kmod.h>
#include <linux/sched.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/workqueue.h>
#include <linux/mii.h>
#include <linux/usb.h>
#include <linux/crc32.h>
#include <linux/usb/usbnet.h>
#include "asix.h"
#define DRIVER_VERSION "4.1.0-kernel"
static const char driver_name[] = "asix";
static char driver_version[] =
"ASIX USB Ethernet Adapter: v" DRIVER_VERSION "\n";
/* configuration of maximum bulk in size */
static int bsize = AX88772B_MAX_BULKIN_16K;
module_param(bsize, int, 0);
MODULE_PARM_DESC(bsize, "Maximum transfer size per bulk");
static void ax88772b_link_reset(struct work_struct *work);
static void ax88772a_link_reset(struct work_struct *work);
static void ax88772_link_reset(struct work_struct *work);
static int ax88772a_phy_powerup(struct usbnet *dev);
/* ASIX AX8817X based USB 2.0 Ethernet Devices */
static int ax8817x_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
u16 size, void *data)
{
return usb_control_msg(
dev->udev,
usb_rcvctrlpipe(dev->udev, 0),
cmd,
USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
value,
index,
data,
size,
USB_CTRL_GET_TIMEOUT);
}
static int ax8817x_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
u16 size, void *data)
{
return usb_control_msg(
dev->udev,
usb_sndctrlpipe(dev->udev, 0),
cmd,
USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
value,
index,
data,
size,
USB_CTRL_SET_TIMEOUT);
}
static void ax8817x_async_cmd_callback(struct urb *urb)
{
struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context;
if (urb->status < 0)
printk(KERN_DEBUG "ax8817x_async_cmd_callback() failed with %d",
urb->status);
kfree(req);
usb_free_urb(urb);
}
static int ax8817x_set_mac_addr(struct net_device *net, void *p)
{
struct usbnet *dev = netdev_priv(net);
struct sockaddr *addr = p;
memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);
/* Set the MAC address */
return ax8817x_write_cmd(dev, AX88772_CMD_WRITE_NODE_ID,
0, 0, ETH_ALEN, net->dev_addr);
}
static void ax8817x_status(struct usbnet *dev, struct urb *urb)
{
struct ax88172_int_data *event;
int link;
if (urb->actual_length < 8)
return;
event = urb->transfer_buffer;
link = event->link & 0x01;
if (netif_carrier_ok(dev->net) != link) {
if (link) {
netif_carrier_on(dev->net);
usbnet_defer_kevent(dev, EVENT_LINK_RESET);
} else
netif_carrier_off(dev->net);
netdev_warn(dev->net, "%s: link status is: %d\n",
__func__, link);
}
}
static void ax88178_status(struct usbnet *dev, struct urb *urb)
{
struct ax88178_data *priv = (struct ax88178_data *)dev->driver_priv;
if (priv->EepromData == PHY_MODE_MAC_TO_MAC_GMII)
return;
ax8817x_status(dev, urb);
}
static void ax88772_status(struct usbnet *dev, struct urb *urb)
{
struct ax88172_int_data *event;
struct ax88772_data *priv = (struct ax88772_data *)dev->driver_priv;
int link;
if (urb->actual_length < 8)
return;
event = urb->transfer_buffer;
link = event->link & 0x01;
if (netif_carrier_ok(dev->net) != link) {
if (link) {
netif_carrier_on(dev->net);
priv->Event = AX_SET_RX_CFG;
} else {
netif_carrier_off(dev->net);
if (priv->Event == AX_NOP) {
priv->Event = PHY_POWER_DOWN;
priv->TickToExpire = 25;
}
}
netdev_warn(dev->net, "%s: link status is: %d\n",
__func__, link);
}
if (priv->Event)
queue_work(priv->ax_work, &priv->check_link);
}
static void ax88772a_status(struct usbnet *dev, struct urb *urb)
{
struct ax88172_int_data *event;
struct ax88772a_data *priv = (struct ax88772a_data *)dev->driver_priv;
int link;
int PowSave = (priv->EepromData >> 14);
if (urb->actual_length < 8)
return;
event = urb->transfer_buffer;
link = event->link & 0x01;
if (netif_carrier_ok(dev->net) != link) {
if (link) {
netif_carrier_on(dev->net);
priv->Event = AX_SET_RX_CFG;
} else if ((PowSave == 0x3) || (PowSave == 0x1)) {
netif_carrier_off(dev->net);
if (priv->Event == AX_NOP) {
priv->Event = CHK_CABLE_EXIST;
priv->TickToExpire = 14;
}
} else {
netif_carrier_off(dev->net);
priv->Event = AX_NOP;
}
netdev_warn(dev->net, "%s: link status is: %d\n",
__func__, link);
}
if (priv->Event)
queue_work(priv->ax_work, &priv->check_link);
}
static void ax88772b_status(struct usbnet *dev, struct urb *urb)
{
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
struct ax88172_int_data *event;
int link;
if (urb->actual_length < 8)
return;
event = urb->transfer_buffer;
link = event->link & AX_INT_PPLS_LINK;
if (netif_carrier_ok(dev->net) != link) {
if (link) {
netif_carrier_on(dev->net);
priv->Event = AX_SET_RX_CFG;
} else {
netif_carrier_off(dev->net);
priv->time_to_chk = jiffies;
}
netdev_warn(dev->net, "%s: link status is: %d\n",
__func__, link);
}
if (!link) {
int no_cable = (event->link & AX_INT_CABOFF_UNPLUG) ? 1 : 0;
if (no_cable) {
if ((priv->psc &
(AX_SWRESET_IPPSL_0 | AX_SWRESET_IPPSL_1)) &&
!priv->pw_enabled) {
/*
* AX88772B already entered power saving state
*/
priv->pw_enabled = 1;
}
} else {
/* AX88772B resumed from power saving state */
if (priv->pw_enabled ||
(jiffies >
(priv->time_to_chk + AX88772B_WATCHDOG))) {
if (priv->pw_enabled)
priv->pw_enabled = 0;
priv->Event = PHY_POWER_UP;
priv->time_to_chk = jiffies;
}
}
}
if (priv->Event)
queue_work(priv->ax_work, &priv->check_link);
}
static void
ax8817x_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index,
u16 size, void *data)
{
struct usb_ctrlrequest *req;
int status;
struct urb *urb;
urb = usb_alloc_urb(0, GFP_ATOMIC);
if (urb == NULL) {
netdev_err(dev->net, "%s: usb_alloc_urb() failed\n", __func__);
return;
}
req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC);
if (req == NULL) {
netdev_err(dev->net, "%s: kmalloc() failed\n", __func__);
usb_free_urb(urb);
return;
}
req->bRequestType = USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
req->bRequest = cmd;
req->wValue = cpu_to_le16(value);
req->wIndex = cpu_to_le16(index);
req->wLength = cpu_to_le16(size);
usb_fill_control_urb(urb, dev->udev,
usb_sndctrlpipe(dev->udev, 0),
(void *)req, data, size,
ax8817x_async_cmd_callback, req);
status = usb_submit_urb(urb, GFP_ATOMIC);
if (status < 0) {
netdev_err(dev->net, "%s: usb_submit_urb() failed, err=%d\n",
__func__, status);
kfree(req);
usb_free_urb(urb);
}
}
static void ax8817x_set_multicast(struct net_device *net)
{
struct usbnet *dev = netdev_priv(net);
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
u8 rx_ctl = AX_RX_CTL_START | AX_RX_CTL_AB;
int mc_count;
mc_count = netdev_mc_count(net);
if (net->flags & IFF_PROMISC) {
rx_ctl |= AX_RX_CTL_PRO;
} else if (net->flags & IFF_ALLMULTI
|| mc_count > AX_MAX_MCAST) {
rx_ctl |= AX_RX_CTL_AMALL;
} else if (mc_count == 0) {
/* just broadcast and directed */
} else {
/* We use the 20 byte dev->data
* for our 8 byte filter buffer
* to avoid allocating memory that
* is tricky to free later */
u32 crc_bits;
struct netdev_hw_addr *ha;
memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);
netdev_for_each_mc_addr(ha, net) {
crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
data->multi_filter[crc_bits >> 3] |=
1 << (crc_bits & 7);
}
ax8817x_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
AX_MCAST_FILTER_SIZE, data->multi_filter);
rx_ctl |= AX_RX_CTL_AM;
}
ax8817x_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
}
static void ax88772b_set_multicast(struct net_device *net)
{
struct usbnet *dev = netdev_priv(net);
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
u16 rx_ctl = (AX_RX_CTL_START | AX_RX_CTL_AB | AX_RX_HEADER_DEFAULT);
int mc_count;
mc_count = netdev_mc_count(net);
if (net->flags & IFF_PROMISC) {
rx_ctl |= AX_RX_CTL_PRO;
} else if (net->flags & IFF_ALLMULTI
|| mc_count > AX_MAX_MCAST) {
rx_ctl |= AX_RX_CTL_AMALL;
} else if (mc_count == 0) {
/* just broadcast and directed */
} else {
/* We use the 20 byte dev->data
* for our 8 byte filter buffer
* to avoid allocating memory that
* is tricky to free later */
u32 crc_bits;
struct netdev_hw_addr *ha;
memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE);
netdev_for_each_mc_addr(ha, net) {
crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
data->multi_filter[crc_bits >> 3] |=
1 << (crc_bits & 7);
}
ax8817x_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0,
AX_MCAST_FILTER_SIZE, data->multi_filter);
rx_ctl |= AX_RX_CTL_AM;
}
ax8817x_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL);
}
static int ax8817x_mdio_read(struct net_device *netdev, int phy_id, int loc)
{
struct usbnet *dev = netdev_priv(netdev);
u16 *res;
u16 ret;
res = kmalloc(2, GFP_ATOMIC);
if (!res)
return 0;
ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, NULL);
ax8817x_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id, (__u16)loc, 2, res);
ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, NULL);
ret = *res & 0xffff;
kfree(res);
return ret;
}
static int
ax8817x_swmii_mdio_read(struct net_device *netdev, int phy_id, int loc)
{
struct usbnet *dev = netdev_priv(netdev);
u16 *res;
u16 ret;
res = kmalloc(2, GFP_ATOMIC);
if (!res)
return 0;
ax8817x_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id,
(__u16)loc, 2, res);
ret = *res & 0xffff;
kfree(res);
return ret;
}
/* same as above, but converts resulting value to cpu byte order */
static int ax8817x_mdio_read_le(struct net_device *netdev, int phy_id, int loc)
{
return le16_to_cpu(ax8817x_mdio_read(netdev, phy_id, loc));
}
static int
ax8817x_swmii_mdio_read_le(struct net_device *netdev, int phy_id, int loc)
{
return le16_to_cpu(ax8817x_swmii_mdio_read(netdev, phy_id, loc));
}
static void
ax8817x_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
{
struct usbnet *dev = netdev_priv(netdev);
u16 *res;
res = kmalloc(2, GFP_ATOMIC);
if (!res)
return;
*res = val;
ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, NULL);
ax8817x_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id,
(__u16)loc, 2, res);
ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, NULL);
kfree(res);
}
static void ax8817x_swmii_mdio_write(struct net_device *netdev,
int phy_id, int loc, int val)
{
struct usbnet *dev = netdev_priv(netdev);
u16 *res;
res = kmalloc(2, GFP_ATOMIC);
if (!res)
return;
*res = val;
ax8817x_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id,
(__u16)loc, 2, res);
kfree(res);
}
static void
ax88772b_mdio_write(struct net_device *netdev, int phy_id, int loc, int val)
{
struct usbnet *dev = netdev_priv(netdev);
u16 *res;
res = kmalloc(2, GFP_ATOMIC);
if (!res)
return;
*res = val;
ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, NULL);
ax8817x_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id,
(__u16)loc, 2, res);
if (loc == MII_ADVERTISE) {
*res = cpu_to_le16(BMCR_ANENABLE | BMCR_ANRESTART);
ax8817x_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id,
(__u16)MII_BMCR, 2, res);
}
ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, NULL);
kfree(res);
}
/* same as above, but converts new value to le16 byte order before writing */
static void
ax8817x_mdio_write_le(struct net_device *netdev, int phy_id, int loc, int val)
{
ax8817x_mdio_write(netdev, phy_id, loc, cpu_to_le16(val));
}
static void ax8817x_swmii_mdio_write_le(struct net_device *netdev,
int phy_id, int loc, int val)
{
ax8817x_swmii_mdio_write(netdev, phy_id, loc, cpu_to_le16(val));
}
static void
ax88772b_mdio_write_le(struct net_device *netdev, int phy_id, int loc, int val)
{
ax88772b_mdio_write(netdev, phy_id, loc, cpu_to_le16(val));
}
static int asix_write_medium_mode(struct usbnet *dev, u16 value)
{
int ret;
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE,
value, 0, 0, NULL);
if (ret < 0)
netdev_err(dev->net, "%s (0x%04x) failed, err=%d\n",
__func__, value, ret);
return ret;
}
static int ax88772_suspend(struct usb_interface *intf,
pm_message_t message)
{
struct usbnet *dev = usb_get_intfdata(intf);
u16 *medium;
medium = kmalloc(2, GFP_ATOMIC);
if (!medium)
return usbnet_suspend(intf, message);
ax8817x_read_cmd(dev, AX_CMD_READ_MEDIUM_MODE, 0, 0, 2, medium);
asix_write_medium_mode(dev, *medium & ~AX88772_MEDIUM_RX_ENABLE);
kfree(medium);
return usbnet_suspend(intf, message);
}
static int ax88772b_suspend(struct usb_interface *intf,
pm_message_t message)
{
struct usbnet *dev = usb_get_intfdata(intf);
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
u16 *tmp16;
u8 *opt;
tmp16 = kmalloc(2, GFP_ATOMIC);
if (!tmp16)
return usbnet_suspend(intf, message);
opt = (u8 *)tmp16;
ax8817x_read_cmd(dev, AX_CMD_READ_MEDIUM_MODE, 0, 0, 2, tmp16);
asix_write_medium_mode(dev, *tmp16 & ~AX88772_MEDIUM_RX_ENABLE);
ax8817x_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, opt);
if (!(*opt & AX_MONITOR_LINK) && !(*opt & AX_MONITOR_MAGIC)) {
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL | AX_SWRESET_IPPD, 0, 0, NULL);
} else {
if (priv->psc & AX_SWRESET_WOLLP) {
*tmp16 = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MII_BMCR);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id,
MII_BMCR, *tmp16 | BMCR_ANENABLE);
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL | priv->psc, 0, 0, NULL);
}
if (priv->psc &
(AX_SWRESET_IPPSL_0 | AX_SWRESET_IPPSL_1)) {
*opt |= AX_MONITOR_LINK;
ax8817x_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE,
*opt, 0, 0, NULL);
}
}
kfree(tmp16);
return usbnet_suspend(intf, message);
}
static int ax88772_resume(struct usb_interface *intf)
{
struct usbnet *dev = usb_get_intfdata(intf);
netif_carrier_off(dev->net);
return usbnet_resume(intf);
}
static int ax88772b_resume(struct usb_interface *intf)
{
struct usbnet *dev = usb_get_intfdata(intf);
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
if (priv->psc & AX_SWRESET_WOLLP) {
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL | (priv->psc & 0x7FFF),
0, 0, NULL);
}
if (priv->psc & (AX_SWRESET_IPPSL_0 | AX_SWRESET_IPPSL_1))
ax88772a_phy_powerup(dev);
netif_carrier_off(dev->net);
return usbnet_resume(intf);
}
static int ax88172_link_reset(struct usbnet *dev)
{
u16 lpa;
u16 adv;
u16 res;
u8 mode;
mode = AX_MEDIUM_TX_ABORT_ALLOW | AX_MEDIUM_FLOW_CONTROL_EN;
lpa = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, MII_LPA);
adv = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, MII_ADVERTISE);
res = mii_nway_result(lpa|adv);
if (res & LPA_DUPLEX)
mode |= AX_MEDIUM_FULL_DUPLEX;
asix_write_medium_mode(dev, mode);
return 0;
}
static void
ax8817x_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
{
struct usbnet *dev = netdev_priv(net);
u8 *opt;
wolinfo->supported = 0;
wolinfo->wolopts = 0;
opt = kmalloc(1, GFP_KERNEL);
if (!opt)
return;
if (ax8817x_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, opt) < 0)
return;
wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
if (*opt & AX_MONITOR_LINK)
wolinfo->wolopts |= WAKE_PHY;
if (*opt & AX_MONITOR_MAGIC)
wolinfo->wolopts |= WAKE_MAGIC;
kfree(opt);
}
static int
ax8817x_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
{
struct usbnet *dev = netdev_priv(net);
u8 *opt;
opt = kmalloc(1, GFP_KERNEL);
if (!opt)
return -ENOMEM;
*opt = 0;
if (wolinfo->wolopts & WAKE_PHY)
*opt |= AX_MONITOR_LINK;
if (wolinfo->wolopts & WAKE_MAGIC)
*opt |= AX_MONITOR_MAGIC;
ax8817x_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE, *opt, 0, 0, NULL);
kfree(opt);
return 0;
}
static int ax8817x_get_eeprom_len(struct net_device *net)
{
return AX_EEPROM_LEN;
}
static int ax8817x_get_eeprom(struct net_device *net,
struct ethtool_eeprom *eeprom, u8 *data)
{
struct usbnet *dev = netdev_priv(net);
u16 *ebuf = (u16 *)data;
int i;
/* Crude hack to ensure that we don't overwrite memory
* if an odd length is supplied
*/
if (eeprom->len % 2)
return -EINVAL;
eeprom->magic = AX_EEPROM_MAGIC;
/* ax8817x returns 2 bytes from eeprom on read */
for (i = 0; i < eeprom->len / 2; i++) {
if (ax8817x_read_cmd(dev, AX_CMD_READ_EEPROM,
eeprom->offset + i, 0, 2, &ebuf[i]) < 0)
return -EINVAL;
}
return 0;
}
static void ax8817x_get_drvinfo(struct net_device *net,
struct ethtool_drvinfo *info)
{
/* Inherit standard device info */
usbnet_get_drvinfo(net, info);
info->eedump_len = 0x3e;
}
static int ax8817x_get_settings(struct net_device *net, struct ethtool_cmd *cmd)
{
struct usbnet *dev = netdev_priv(net);
return mii_ethtool_gset(&dev->mii, cmd);
}
static int ax8817x_set_settings(struct net_device *net, struct ethtool_cmd *cmd)
{
struct usbnet *dev = netdev_priv(net);
return mii_ethtool_sset(&dev->mii, cmd);
}
/*
* We need to override some ethtool_ops so we require our
* own structure so we don't interfere with other usbnet
* devices that may be connected at the same time.
*/
static struct ethtool_ops ax8817x_ethtool_ops = {
.get_drvinfo = ax8817x_get_drvinfo,
.get_link = ethtool_op_get_link,
.get_msglevel = usbnet_get_msglevel,
.set_msglevel = usbnet_set_msglevel,
.get_wol = ax8817x_get_wol,
.set_wol = ax8817x_set_wol,
.get_eeprom_len = ax8817x_get_eeprom_len,
.get_eeprom = ax8817x_get_eeprom,
.get_settings = ax8817x_get_settings,
.set_settings = ax8817x_set_settings,
};
static int ax8817x_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
{
struct usbnet *dev = netdev_priv(net);
return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
}
static const struct net_device_ops ax88x72_netdev_ops = {
.ndo_open = usbnet_open,
.ndo_stop = usbnet_stop,
.ndo_start_xmit = usbnet_start_xmit,
.ndo_tx_timeout = usbnet_tx_timeout,
.ndo_change_mtu = usbnet_change_mtu,
.ndo_do_ioctl = ax8817x_ioctl,
.ndo_set_mac_address = ax8817x_set_mac_addr,
.ndo_validate_addr = eth_validate_addr,
.ndo_set_multicast_list = ax8817x_set_multicast,
};
static int asix_read_mac(struct usbnet *dev, u8 op)
{
u8 *buf;
int ret, len = ETH_ALEN;
buf = kzalloc(len, GFP_KERNEL);
if (!buf) {
netdev_err(dev->net, "%s kzalloc failed\n", __func__);
return -ENOMEM;
}
ret = ax8817x_read_cmd(dev, op, 0, 0, len, buf);
if (ret < 0) {
netdev_err(dev->net, "%s failed, err=%d\n", __func__, ret);
} else {
memcpy(dev->net->dev_addr, buf, len);
ret = 0;
}
kfree(buf);
return ret;
}
static int asix_read_phyid(struct usbnet *dev, u8 op)
{
u8 *buf;
int ret, len = 2;
buf = kzalloc(len, GFP_KERNEL);
if (!buf) {
netdev_err(dev->net, "%s kzalloc failed\n", __func__);
return -ENOMEM;
}
ret = ax8817x_read_cmd(dev, op, 0, 0, len, buf);
if (ret < 0) {
netdev_err(dev->net, "%s failed, err=%d\n", __func__, ret);
} else if (ret < len) {
netdev_err(dev->net, "%s read only %d/%d bytes\n",
__func__, ret, len);
ret = -EIO;
} else {
dev->mii.phy_id = buf[1];
ret = 0;
}
kfree(buf);
return ret;
}
static int asix_read_eeprom_le16(struct usbnet *dev, u8 offset, u16 *data)
{
u16 *buf;
int ret, len = 2;
buf = kzalloc(len, GFP_KERNEL);
if (!buf) {
netdev_err(dev->net, "%s kzalloc failed\n", __func__);
return -ENOMEM;
}
ret = ax8817x_read_cmd(dev, AX_CMD_READ_EEPROM, offset, 0, len, buf);
if (ret != 2) {
netdev_err(dev->net, "%s failed offset 0x%02x, err=%d\n",
__func__, offset, ret);
} else {
le16_to_cpus(buf);
*data = *buf;
ret = 0;
}
kfree(buf);
return ret;
}
static int asix_read_mac_from_eeprom(struct usbnet *dev)
{
u16 buf[ETH_ALEN / 2];
int i, ret;
memset(buf, 0, sizeof(buf));
for (i = 0; i < ETH_ALEN; i += 2) {
ret = asix_read_eeprom_le16(dev, i + 4, buf + i);
if (ret < 0) {
netdev_err(dev->net, "%s failed\n", __func__);
return ret;
}
}
memcpy(dev->net->dev_addr, buf, ETH_ALEN);
return 0;
}
static int asix_phy_select(struct usbnet *dev, u16 physel)
{
int ret;
ret = ax8817x_write_cmd(dev, AX_CMD_SW_PHY_SELECT, physel, 0, 0, NULL);
if (ret < 0)
netdev_err(dev->net, "%s (0x%04x) failed, err=%d\n",
__func__, physel, ret);
return ret;
}
static int asix_write_gpio(struct usbnet *dev, unsigned int wait, u16 value)
{
int ret;
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s (0x%x) failed\n", __func__, value);
return ret;
}
if (!wait)
wait = 5;
if (wait < 20)
usleep_range(wait * 1000, wait * (1000 * 2));
else
msleep(wait);
return 0;
}
static int ax8817x_bind(struct usbnet *dev, struct usb_interface *intf)
{
int ret = 0;
int i;
unsigned long gpio_bits = dev->driver_info->data;
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
usbnet_get_endpoints(dev, intf);
/* Toggle the GPIOs in a manufacturer/model specific way */
for (i = 2; i >= 0; i--) {
ret = asix_write_gpio(dev, 0, (gpio_bits >> (i * 8)) & 0xff);
if (ret)
goto err_out;
}
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL, 0x80, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: WRITE_RX_CTL failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Get the MAC address */
ret = asix_read_mac(dev, AX_CMD_READ_NODE_ID);
if (ret < 0)
goto err_out;
/* Get the PHY id */
ret = asix_read_phyid(dev, AX_CMD_READ_PHY_ID);
if (ret < 0)
goto err_out;
/* Initialize MII structure */
dev->mii.dev = dev->net;
dev->mii.mdio_read = ax8817x_mdio_read_le;
dev->mii.mdio_write = ax8817x_mdio_write_le;
dev->mii.phy_id_mask = 0x3f;
dev->mii.reg_num_mask = 0x1f;
dev->net->netdev_ops = &ax88x72_netdev_ops;
dev->net->ethtool_ops = &ax8817x_ethtool_ops;
/* Register suspend and resume functions */
data->suspend = usbnet_suspend;
data->resume = usbnet_resume;
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
mii_nway_restart(&dev->mii);
printk(KERN_INFO "%s\n", driver_version);
return 0;
err_out:
return ret;
}
static struct ethtool_ops ax88772_ethtool_ops = {
.get_drvinfo = ax8817x_get_drvinfo,
.get_link = ethtool_op_get_link,
.get_msglevel = usbnet_get_msglevel,
.set_msglevel = usbnet_set_msglevel,
.get_wol = ax8817x_get_wol,
.set_wol = ax8817x_set_wol,
.get_eeprom_len = ax8817x_get_eeprom_len,
.get_eeprom = ax8817x_get_eeprom,
.get_settings = ax8817x_get_settings,
.set_settings = ax8817x_set_settings,
};
static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf)
{
int ret;
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
struct ax88772_data *priv;
usbnet_get_endpoints(dev, intf);
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
if (!priv) {
netdev_err(dev->net, "%s: kzalloc(priv) failed\n", __func__);
return -ENOMEM;
}
dev->driver_priv = priv;
priv->ax_work = create_singlethread_workqueue("ax88772");
if (!priv->ax_work) {
netdev_err(dev->net, "%s: create workqueue failed\n", __func__);
kfree(priv);
return -ENOMEM;
}
priv->dev = dev;
INIT_WORK(&priv->check_link, ax88772_link_reset);
/* reload eeprom data */
ret = asix_write_gpio(dev, 0, AXGPIOS_RSE|AXGPIOS_GPO2|AXGPIOS_GPO2EN);
if (ret)
goto err_out;
/* Initialize MII structure */
dev->mii.dev = dev->net;
dev->mii.mdio_read = ax8817x_mdio_read_le;
dev->mii.mdio_write = ax8817x_mdio_write_le;
dev->mii.phy_id_mask = 0xff;
dev->mii.reg_num_mask = 0xff;
/* Get the PHY id */
ret = asix_read_phyid(dev, AX_CMD_READ_PHY_ID);
if (ret < 0)
goto err_out;
if (dev->mii.phy_id == 0x10) {
ret = asix_phy_select(dev, 0x0001);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to power down PHY"
", err=%d\n", __func__, ret);
goto err_out;
}
msleep(150);
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_CLEAR, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: SW_RESET failed, err=%d\n",
__func__, ret);
goto err_out;
}
msleep(150);
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL | AX_SWRESET_PRL, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to set PHY reset "
"control, err=%d\n", __func__, ret);
goto err_out;
}
} else {
ret = asix_phy_select(dev, 0x0000);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD | AX_SWRESET_PRL, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to power down "
"internal PHY, err=%d\n", __func__, ret);
goto err_out;
}
}
msleep(150);
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL, 0x0000, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to reset RX_CTL, err=%d\n",
__func__, ret);
goto err_out;
}
/* Get the MAC address */
ret = asix_read_mac(dev, AX88772_CMD_READ_NODE_ID);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to enable software MII"
", err=%d\n", __func__, ret);
goto err_out;
}
if (dev->mii.phy_id == 0x10) {
ret = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, 2);
if (ret != 0x003b) {
netdev_err(dev->net, "%s: PHY reg 2 not 0x3b00: 0x%x\n",
__func__, ret);
goto err_out;
}
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_PRL, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to set "
"external PHY reset pin level, err=%d\n",
__func__, ret);
goto err_out;
}
msleep(150);
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL | AX_SWRESET_PRL, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Failed to set "
"internal/external PHY reset control, err=%d\n",
__func__, ret);
goto err_out;
}
msleep(150);
}
dev->net->netdev_ops = &ax88x72_netdev_ops;
dev->net->ethtool_ops = &ax88772_ethtool_ops;
/* Register suspend and resume functions */
data->suspend = ax88772_suspend;
data->resume = ax88772_resume;
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA);
mii_nway_restart(&dev->mii);
priv->autoneg_start = jiffies;
priv->Event = WAIT_AUTONEG_COMPLETE;
ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_IPG0,
AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT << 8,
AX88772_IPG2_DEFAULT, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: WRITE_IPG0/1/2 failed, err=%d\n",
__func__, ret);
goto err_out;
}
ret = ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: SET_HW_MII failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Set RX_CTL to default values with 2k buffer, and enable cactus */
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL, 0x0088, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: WRITE_RX_CTL failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
if (dev->driver_info->flags & FLAG_FRAMING_AX) {
/*
* hard_mtu is still the default;
* the device does not support jumbo eth frames
*/
dev->rx_urb_size = 2048;
}
printk(KERN_INFO "%s\n", driver_version);
return 0;
err_out:
destroy_workqueue(priv->ax_work);
kfree(priv);
return ret;
}
static void ax88772_unbind(struct usbnet *dev, struct usb_interface *intf)
{
struct ax88772_data *priv = (struct ax88772_data *)dev->driver_priv;
if (priv) {
flush_workqueue(priv->ax_work);
destroy_workqueue(priv->ax_work);
/* stop MAC operation */
ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_STOP, 0, 0, NULL);
/* Power down PHY */
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD, 0, 0, NULL);
kfree(priv);
}
}
static int ax88772a_phy_powerup(struct usbnet *dev)
{
int ret;
/* set the embedded Ethernet PHY in power-down state */
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD | AX_SWRESET_IPRL, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: power down PHY failed, err=%d\n",
__func__, ret);
return ret;
}
msleep(20); /* was 10ms */
/* set the embedded Ethernet PHY in power-up state */
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET, AX_SWRESET_IPRL,
0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: reset PHY failed, err=%d\n",
__func__, ret);
return ret;
}
msleep(600);
/* set the embedded Ethernet PHY in reset state */
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET, AX_SWRESET_CLEAR,
0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: power up PHY failed, err=%d\n",
__func__, ret);
return ret;
}
/* set the embedded Ethernet PHY in power-up state */
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET, AX_SWRESET_IPRL,
0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: second reset PHY failed, err=%d\n",
__func__, ret);
return ret;
}
return 0;
}
static int ax88772a_bind(struct usbnet *dev, struct usb_interface *intf)
{
int ret = -EIO;
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
struct ax88772a_data *priv;
usbnet_get_endpoints(dev, intf);
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
if (!priv) {
netdev_err(dev->net, "%s: kzalloc(priv) failed\n", __func__);
return -ENOMEM;
}
dev->driver_priv = priv;
priv->ax_work = create_singlethread_workqueue("ax88772a");
if (!priv->ax_work) {
netdev_err(dev->net, "%s: create workqueue failed\n", __func__);
kfree(priv);
return -ENOMEM;
}
priv->dev = dev;
INIT_WORK(&priv->check_link, ax88772a_link_reset);
/* Get the EEPROM data*/
ret = asix_read_eeprom_le16(dev, 0x17, &priv->EepromData);
if (ret < 0)
goto err_out;
/* reload eeprom data */
ret = asix_write_gpio(dev, 0, AXGPIOS_RSE);
if (ret)
goto err_out;
/* Initialize MII structure */
dev->mii.dev = dev->net;
dev->mii.mdio_read = ax8817x_mdio_read_le;
dev->mii.mdio_write = ax8817x_mdio_write_le;
dev->mii.phy_id_mask = 0xff;
dev->mii.reg_num_mask = 0xff;
/* Get the PHY id */
ret = asix_read_phyid(dev, AX_CMD_READ_PHY_ID);
if (ret < 0)
goto err_out;
if (dev->mii.phy_id != 0x10) {
netdev_err(dev->net, "%s: Got wrong PHY_ID: 0x%02x\n",
__func__, dev->mii.phy_id);
ret = -EIO;
goto err_out;
}
/* select the embedded 10/100 Ethernet PHY */
ret = asix_phy_select(dev,
AX_PHYSEL_SSEN | AX_PHYSEL_PSEL | AX_PHYSEL_SSMII);
if (ret < 0)
goto err_out;
ret = ax88772a_phy_powerup(dev);
if (ret < 0)
goto err_out;
/* stop MAC operation */
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_STOP, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: reset RX_CTL failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Get the MAC address */
ret = asix_read_mac(dev, AX88772_CMD_READ_NODE_ID);
if (ret < 0)
goto err_out;
/* make sure the driver can enable sw mii operation */
ret = ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: enable software MII failed, err=%d\n",
__func__, ret);
goto err_out;
}
dev->net->netdev_ops = &ax88x72_netdev_ops;
dev->net->ethtool_ops = &ax88772_ethtool_ops;
/* Register suspend and resume functions */
data->suspend = ax88772_suspend;
data->resume = ax88772_resume;
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
mii_nway_restart(&dev->mii);
priv->autoneg_start = jiffies;
priv->Event = WAIT_AUTONEG_COMPLETE;
ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_IPG0,
AX88772A_IPG0_DEFAULT | AX88772A_IPG1_DEFAULT << 8,
AX88772A_IPG2_DEFAULT, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: write IPG,IPG1,IPG2 failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Set RX_CTL to default values with 2k buffer, and enable cactus */
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_START | AX_RX_CTL_AB, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: Reset RX_CTL failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
if (dev->driver_info->flags & FLAG_FRAMING_AX) {
/*
* hard_mtu is still the default;
* the device does not support jumbo eth frames
*/
dev->rx_urb_size = 2048;
}
printk(KERN_INFO "%s\n", driver_version);
return ret;
err_out:
destroy_workqueue(priv->ax_work);
kfree(priv);
return ret;
}
static void ax88772a_unbind(struct usbnet *dev, struct usb_interface *intf)
{
struct ax88772a_data *priv = (struct ax88772a_data *)dev->driver_priv;
if (priv) {
flush_workqueue(priv->ax_work);
destroy_workqueue(priv->ax_work);
/* stop MAC operation */
ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_STOP, 0, 0, NULL);
/* Power down PHY */
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD, 0, 0, NULL);
kfree(priv);
}
}
static int ax88772b_set_csums(struct usbnet *dev)
{
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
u16 checksum;
if (priv->checksum & AX_RX_CHECKSUM)
checksum = AX_RXCOE_DEF_CSUM;
else
checksum = 0;
if (priv->checksum & AX_TX_CHECKSUM)
checksum = AX_TXCOE_DEF_CSUM;
else
checksum = 0;
ax8817x_write_cmd(dev, AX_CMD_WRITE_RXCOE_CTL,
checksum, 0, 0, NULL);
ax8817x_write_cmd(dev, AX_CMD_WRITE_TXCOE_CTL,
checksum, 0, 0, NULL);
return 0;
}
static int ax88772b_set_features(struct net_device *netdev, u32 features)
{
struct usbnet *dev = netdev_priv(netdev);
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
unsigned long flags;
u16 tx_csum = 0, rx_csum = 0;
spin_lock_irqsave(&priv->checksum_lock, flags);
if (features & NETIF_F_HW_CSUM) {
priv->checksum |= AX_TX_CHECKSUM;
tx_csum = AX_TXCOE_DEF_CSUM;
} else
priv->checksum &= ~AX_TX_CHECKSUM;
if (features & NETIF_F_RXCSUM) {
priv->checksum |= AX_RX_CHECKSUM;
rx_csum = AX_RXCOE_DEF_CSUM;
} else
priv->checksum &= ~AX_RX_CHECKSUM;
spin_unlock_irqrestore(&priv->checksum_lock, flags);
ax8817x_write_cmd(dev, AX_CMD_WRITE_RXCOE_CTL,
rx_csum, 0, 0, NULL);
ax8817x_write_cmd(dev, AX_CMD_WRITE_TXCOE_CTL,
tx_csum, 0, 0, NULL);
return 0;
}
static struct ethtool_ops ax88772b_ethtool_ops = {
.get_drvinfo = ax8817x_get_drvinfo,
.get_link = ethtool_op_get_link,
.get_msglevel = usbnet_get_msglevel,
.set_msglevel = usbnet_set_msglevel,
.get_wol = ax8817x_get_wol,
.set_wol = ax8817x_set_wol,
.get_eeprom_len = ax8817x_get_eeprom_len,
.get_eeprom = ax8817x_get_eeprom,
.get_settings = ax8817x_get_settings,
.set_settings = ax8817x_set_settings,
};
static const struct net_device_ops ax88772b_netdev_ops = {
.ndo_open = usbnet_open,
.ndo_stop = usbnet_stop,
.ndo_start_xmit = usbnet_start_xmit,
.ndo_tx_timeout = usbnet_tx_timeout,
.ndo_change_mtu = usbnet_change_mtu,
.ndo_do_ioctl = ax8817x_ioctl,
.ndo_set_mac_address = ax8817x_set_mac_addr,
.ndo_validate_addr = eth_validate_addr,
.ndo_set_multicast_list = ax88772b_set_multicast,
.ndo_set_features = ax88772b_set_features,
};
static int ax88772b_bind(struct usbnet *dev, struct usb_interface *intf)
{
int ret;
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
struct ax88772b_data *priv;
int rx_size;
u16 tmp16;
usbnet_get_endpoints(dev, intf);
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
if (!priv) {
netdev_err(dev->net, "%s: kzalloc(priv) failed\n", __func__);
return -ENOMEM;
}
spin_lock_init(&priv->checksum_lock);
dev->driver_priv = priv;
priv->ax_work = create_singlethread_workqueue("ax88772b");
if (!priv->ax_work) {
netdev_err(dev->net, "%s: create workqueue failed\n", __func__);
kfree(priv);
return -ENOMEM;
}
priv->dev = dev;
INIT_WORK(&priv->check_link, ax88772b_link_reset);
/* reload eeprom data */
ret = asix_write_gpio(dev, 0, AXGPIOS_RSE);
if (ret)
goto err_out;
/* Get the EEPROM data*/
ret = asix_read_eeprom_le16(dev, 0x18, &priv->psc);
if (ret < 0)
goto err_out;
priv->psc &= 0xFF00;
/* Get the MAC address from the eeprom */
ret = asix_read_mac_from_eeprom(dev);
if (ret < 0)
goto err_out;
/* Set the MAC address */
ret = ax8817x_write_cmd(dev, AX88772_CMD_WRITE_NODE_ID,
0, 0, ETH_ALEN, dev->net->dev_addr);
if (ret < 0) {
netdev_err(dev->net, "%s: set mac addr failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Initialize MII structure */
dev->mii.dev = dev->net;
dev->mii.mdio_read = ax8817x_mdio_read_le;
dev->mii.mdio_write = ax88772b_mdio_write_le;
dev->mii.phy_id_mask = 0xff;
dev->mii.reg_num_mask = 0xff;
/* Get the PHY id */
ret = asix_read_phyid(dev, AX_CMD_READ_PHY_ID);
if (ret < 0)
goto err_out;
if (dev->mii.phy_id != 0x10) {
netdev_err(dev->net, "%s: Got wrong PHY_ID: 0x%02x\n",
__func__, dev->mii.phy_id);
ret = -EIO;
goto err_out;
}
/* select the embedded 10/100 Ethernet PHY */
ret = asix_phy_select(dev,
AX_PHYSEL_SSEN | AX_PHYSEL_PSEL | AX_PHYSEL_SSMII);
if (ret < 0)
goto err_out;
ret = ax88772a_phy_powerup(dev);
if (ret < 0)
goto err_out;
/* stop MAC operation */
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_STOP, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: reset RX_CTL failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* make sure the driver can enable sw mii operation */
ret = ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: enable software MII failed, err=%d\n",
__func__, ret);
goto err_out;
}
dev->net->netdev_ops = &ax88772b_netdev_ops;
dev->net->ethtool_ops = &ax88772b_ethtool_ops;
/* Register suspend and resume functions */
data->suspend = ax88772b_suspend;
data->resume = ax88772b_resume;
tmp16 = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, 0x12);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, 0x12,
((tmp16 & 0xFF9F) | 0x0040));
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
mii_nway_restart(&dev->mii);
ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_IPG0,
AX88772A_IPG0_DEFAULT | AX88772A_IPG1_DEFAULT << 8,
AX88772A_IPG2_DEFAULT, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: write interfram gap failed, err=%d\n",
__func__, ret);
goto err_out;
}
dev->net->features |= NETIF_F_IP_CSUM;
dev->net->features |= NETIF_F_IPV6_CSUM;
priv->checksum = AX_RX_CHECKSUM | AX_TX_CHECKSUM;
ret = ax88772b_set_csums(dev);
if (ret < 0) {
netdev_err(dev->net, "%s: write RX_COE/TX_COE failed, err=%d\n",
__func__, ret);
goto err_out;
}
rx_size = bsize & 0x07;
if (dev->udev->speed == USB_SPEED_HIGH) {
ret = ax8817x_write_cmd(dev, 0x2A,
AX88772B_BULKIN_SIZE[rx_size].byte_cnt,
AX88772B_BULKIN_SIZE[rx_size].threshold,
0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: set rx_size failed, err=%d\n",
__func__, ret);
goto err_out;
}
dev->rx_urb_size = AX88772B_BULKIN_SIZE[rx_size].size;
} else {
ret = ax8817x_write_cmd(dev, 0x2A, 0x8000, 0x8001, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: set rx_size failed, err=%d\n",
__func__, ret);
goto err_out;
}
dev->rx_urb_size = 2048;
}
/* Configure RX header type */
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
(AX_RX_CTL_START | AX_RX_CTL_AB | AX_RX_HEADER_DEFAULT),
0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: reset RX_CTL failed, err=%d\n",
__func__, ret);
goto err_out;
}
/* Overwrite power saving configuration from eeprom */
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL | (priv->psc & 0x7FFF), 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: set phy power saving failed, err=%d\n",
__func__, ret);
goto err_out;
}
printk(KERN_INFO "%s\n", driver_version);
return ret;
err_out:
destroy_workqueue(priv->ax_work);
kfree(priv);
return ret;
}
static void ax88772b_unbind(struct usbnet *dev, struct usb_interface *intf)
{
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
if (priv) {
flush_workqueue(priv->ax_work);
destroy_workqueue(priv->ax_work);
/* stop MAC operation */
ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_STOP, 0, 0, NULL);
/* Power down PHY */
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD, 0, 0, NULL);
kfree(priv);
}
}
static int
ax88178_media_check(struct usbnet *dev, struct ax88178_data *priv)
{
int fullduplex;
u16 tempshort = 0;
u16 media;
u16 advertise, lpa, result, stat1000;
advertise = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MII_ADVERTISE);
lpa = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, MII_LPA);
result = advertise & lpa;
stat1000 = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MII_STAT1000);
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1)) {
tempshort = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MARVELL_MANUAL_LED) & 0xfc0f;
}
fullduplex = 1;
if (stat1000 & LPA_1000FULL) {
media = MEDIUM_GIGA_MODE | MEDIUM_FULL_DUPLEX_MODE |
MEDIUM_ENABLE_125MHZ | MEDIUM_ENABLE_RECEIVE;
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1))
tempshort |= 0x3e0;
} else if (result & LPA_100FULL) {
media = MEDIUM_FULL_DUPLEX_MODE | MEDIUM_ENABLE_RECEIVE |
MEDIUM_MII_100M_MODE;
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1))
tempshort |= 0x3b0;
} else if (result & LPA_100HALF) {
fullduplex = 0;
media = MEDIUM_ENABLE_RECEIVE | MEDIUM_MII_100M_MODE;
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1))
tempshort |= 0x3b0;
} else if (result & LPA_10FULL) {
media = MEDIUM_FULL_DUPLEX_MODE | MEDIUM_ENABLE_RECEIVE;
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1))
tempshort |= 0x2f0;
} else {
media = MEDIUM_ENABLE_RECEIVE;
fullduplex = 0;
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1))
tempshort |= 0x02f0;
}
if ((priv->PhyMode == PHY_MODE_MARVELL) &&
(priv->LedMode == 1)) {
ax8817x_mdio_write_le(dev->net,
dev->mii.phy_id, MARVELL_MANUAL_LED, tempshort);
}
media |= 0x0004;
if (priv->UseRgmii)
media |= 0x0008;
if (fullduplex) {
media |= 0x0020; /* enable tx flow control as default */
media |= 0x0010; /* enable rx flow control as default */
}
return media;
}
static void Vitess_8601_Init(struct usbnet *dev, int State)
{
u16 reg;
switch (State) {
case 0: /* tx, rx clock skew */
ax8817x_swmii_mdio_write_le(dev->net, dev->mii.phy_id, 31, 1);
ax8817x_swmii_mdio_write_le(dev->net, dev->mii.phy_id, 28, 0);
ax8817x_swmii_mdio_write_le(dev->net, dev->mii.phy_id, 31, 0);
break;
case 1:
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 31, 0x52B5);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18, 0x009E);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, 0xDD39);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87AA);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0xA7B4);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18,
ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 18));
reg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 17) & ~0x003f) | 0x003c;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, reg);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87B4);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0xa794);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18,
ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 18));
reg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 17) & ~0x003f) | 0x003e;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, reg);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x8794);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18, 0x00f7);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, 0xbe36);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x879e);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0xa7a0);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18,
ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 18));
reg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 17) & ~0x003f) | 0x0034;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, reg);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87a0);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18, 0x003c);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, 0xf3cf);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87a2);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18, 0x003c);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, 0xf3cf);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87a4);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18, 0x003c);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, 0xd287);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87a6);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0xa7a8);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18,
ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 18));
reg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 17) & ~0x0fff) | 0x0125;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, reg);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87a8);
/* Enable Smart Pre-emphasis */
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0xa7fa);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18,
ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 18));
reg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 17) & ~0x0008) | 0x0008;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, reg);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87fa);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 31, 0);
break;
}
}
static int
ax88178_phy_init(struct usbnet *dev, struct ax88178_data *priv)
{
int i;
u16 PhyAnar, PhyAuxCtrl, PhyCtrl, TempShort, PhyID1;
u16 PhyReg = 0;
/* Disable MII operation of AX88178 Hardware */
ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL);
/* Read SROM - MiiPhy Address (ID) */
ax8817x_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, &dev->mii.phy_id);
le16_to_cpus(&dev->mii.phy_id);
/* Initialize MII structure */
dev->mii.phy_id >>= 8;
dev->mii.phy_id &= PHY_ID_MASK;
dev->mii.dev = dev->net;
dev->mii.mdio_read = ax8817x_mdio_read_le;
dev->mii.mdio_write = ax8817x_mdio_write_le;
dev->mii.phy_id_mask = 0x3f;
dev->mii.reg_num_mask = 0x1f;
dev->mii.supports_gmii = 1;
if (priv->PhyMode == PHY_MODE_MAC_TO_MAC_GMII) {
priv->UseRgmii = 0;
priv->MediaLink = MEDIUM_GIGA_MODE |
MEDIUM_FULL_DUPLEX_MODE |
MEDIUM_ENABLE_125MHZ |
MEDIUM_ENABLE_RECEIVE |
MEDIUM_ENABLE_RX_FLOWCTRL |
MEDIUM_ENABLE_TX_FLOWCTRL;
goto SkipPhySetting;
}
/* test read phy register 2 */
if (!priv->UseGpio0) {
i = 1000;
while (i--) {
PhyID1 = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, MII_PHYSID1);
if ((PhyID1 == 0x000f) || (PhyID1 == 0x0141) ||
(PhyID1 == 0x0282) || (PhyID1 == 0x004d) ||
(PhyID1 == 0x0243) || (PhyID1 == 0x001C) ||
(PhyID1 == 0x0007))
break;
usleep_range(5, 20);
}
if (i < 0)
return -EIO;
}
priv->UseRgmii = 0;
if (priv->PhyMode == PHY_MODE_MARVELL) {
PhyReg = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 27);
if (!(PhyReg & 4)) {
priv->UseRgmii = 1;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 20, 0x82);
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
}
} else if ((priv->PhyMode == PHY_MODE_AGERE_V0) ||
(priv->PhyMode == PHY_MODE_AGERE_V0_GMII)) {
if (priv->PhyMode == PHY_MODE_AGERE_V0) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
}
} else if (priv->PhyMode == PHY_MODE_CICADA_V1) {
/* not Cameo */
if (!priv->UseGpio0 || priv->LedMode) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
}
for (i = 0; i < (sizeof(CICADA_FAMILY_HWINIT) /
sizeof(CICADA_FAMILY_HWINIT[0])); i++) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id,
CICADA_FAMILY_HWINIT[i].offset,
CICADA_FAMILY_HWINIT[i].value);
}
} else if (priv->PhyMode == PHY_MODE_CICADA_V2) {
/* not Cameo */
if (!priv->UseGpio0 || priv->LedMode) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
}
for (i = 0; i < (sizeof(CICADA_V2_HWINIT) /
sizeof(CICADA_V2_HWINIT[0])); i++) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, CICADA_V2_HWINIT[i].offset,
CICADA_V2_HWINIT[i].value);
}
} else if (priv->PhyMode == PHY_MODE_CICADA_V2_ASIX) {
/* not Cameo */
if (!priv->UseGpio0 || priv->LedMode) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
}
for (i = 0; i < (sizeof(CICADA_V2_HWINIT) /
sizeof(CICADA_V2_HWINIT[0])); i++) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, CICADA_V2_HWINIT[i].offset,
CICADA_V2_HWINIT[i].value);
}
} else if (priv->PhyMode == PHY_MODE_RTL8211CL) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
} else if (priv->PhyMode == PHY_MODE_RTL8211BN) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
} else if (priv->PhyMode == PHY_MODE_RTL8251CL) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
} else if (priv->PhyMode == PHY_MODE_VSC8601) {
priv->UseRgmii = 1;
priv->MediaLink |= MEDIUM_ENABLE_125MHZ;
/* Vitess_8601_Init(dev, 0); */
}
if (priv->PhyMode != PHY_MODE_ATTANSIC_V0) {
/* software reset */
ax8817x_swmii_mdio_write_le(
dev->net, dev->mii.phy_id, MII_BMCR,
ax8817x_swmii_mdio_read_le(
dev->net, dev->mii.phy_id, MII_BMCR)
| BMCR_RESET);
usleep_range(1000, 2000);
}
if ((priv->PhyMode == PHY_MODE_AGERE_V0) ||
(priv->PhyMode == PHY_MODE_AGERE_V0_GMII)) {
if (priv->PhyMode == PHY_MODE_AGERE_V0) {
i = 1000;
while (i--) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 21, 0x1001);
PhyReg = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 21);
if ((PhyReg & 0xf00f) == 0x1001)
break;
}
if (i < 0)
return -EIO;
}
if (priv->LedMode == 4) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 28, 0x7417);
} else if (priv->LedMode == 9) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 28, 0x7a10);
} else if (priv->LedMode == 10) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 28, 0x7a13);
}
for (i = 0; i < (sizeof(AGERE_FAMILY_HWINIT) /
sizeof(AGERE_FAMILY_HWINIT[0])); i++) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, AGERE_FAMILY_HWINIT[i].offset,
AGERE_FAMILY_HWINIT[i].value);
}
} else if (priv->PhyMode == PHY_MODE_RTL8211CL) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x1f, 0x0005);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x0c, 0);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x01,
(ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 0x01) | 0x0080));
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x1f, 0);
if (priv->LedMode == 12) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x1f, 0x0002);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x1a, 0x00cb);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 0x1f, 0);
}
} else if (priv->PhyMode == PHY_MODE_VSC8601) {
Vitess_8601_Init(dev, 1);
}
/* read phy register 0 */
PhyCtrl = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, MII_BMCR);
TempShort = PhyCtrl;
PhyCtrl &= ~(BMCR_PDOWN | BMCR_ISOLATE);
if (PhyCtrl != TempShort) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, MII_BMCR, PhyCtrl);
}
/* led */
if (priv->PhyMode == PHY_MODE_MARVELL) {
if (priv->LedMode == 1) {
PhyReg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 24) & 0xf8ff) | (1 + 0x100);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 24, PhyReg);
PhyReg = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 25) & 0xfc0f;
} else if (priv->LedMode == 2) {
PhyReg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 24) & 0xf886) |
(1 + 0x10 + 0x300);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 24, PhyReg);
} else if (priv->LedMode == 5) {
PhyReg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 24) & 0xf8be) |
(1 + 0x40 + 0x300);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 24, PhyReg);
} else if (priv->LedMode == 7) {
PhyReg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 24) & 0xf8ff) |
(1 + 0x100);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 24, PhyReg);
} else if (priv->LedMode == 8) {
PhyReg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 24) & 0xf8be) |
(1 + 0x40 + 0x100);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 24, PhyReg);
} else if (priv->LedMode == 11) {
PhyReg = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 24) & 0x4106;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 24, PhyReg);
}
} else if ((priv->PhyMode == PHY_MODE_CICADA_V1) ||
(priv->PhyMode == PHY_MODE_CICADA_V2) ||
(priv->PhyMode == PHY_MODE_CICADA_V2_ASIX)) {
if (priv->LedMode == 3) {
PhyReg = (ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 27) & 0xFCFF) | 0x0100;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 27, PhyReg);
}
}
if (priv->PhyMode == PHY_MODE_MARVELL) {
if (priv->LedMode == 1)
PhyReg |= 0x3f0;
}
PhyAnar = ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP |
ADVERTISE_100FULL | ADVERTISE_100HALF |
ADVERTISE_10FULL | ADVERTISE_10HALF |
ADVERTISE_PAUSE_ASYM;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, MII_ADVERTISE, PhyAnar);
PhyAuxCtrl = ADVERTISE_1000FULL;
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, MII_CTRL1000, PhyAuxCtrl);
if (priv->PhyMode == PHY_MODE_VSC8601) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 31, 0x52B5);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0xA7F8);
TempShort = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 17) & (~0x0018);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 17, TempShort);
TempShort = ax8817x_swmii_mdio_read_le(dev->net,
dev->mii.phy_id, 18);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 18, TempShort);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 16, 0x87F8);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 31, 0);
}
if (priv->PhyMode == PHY_MODE_ATTANSIC_V0) {
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, MII_BMCR, 0x9000);
} else {
PhyCtrl &= ~BMCR_LOOPBACK;
PhyCtrl |= (BMCR_ANENABLE | BMCR_ANRESTART);
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, MII_BMCR, PhyCtrl);
}
if (priv->PhyMode == PHY_MODE_MARVELL) {
if (priv->LedMode == 1)
ax8817x_swmii_mdio_write_le(dev->net,
dev->mii.phy_id, 25, PhyReg);
}
SkipPhySetting:
asix_write_medium_mode(dev, priv->MediaLink);
ax8817x_write_cmd(dev, AX_CMD_WRITE_IPG0,
AX88772_IPG0_DEFAULT | (AX88772_IPG1_DEFAULT << 8),
AX88772_IPG2_DEFAULT, 0, NULL);
usleep_range(1000, 2000);
ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, NULL);
return 0;
}
static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf)
{
int ret;
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
struct ax88178_data *priv;
usbnet_get_endpoints(dev, intf);
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
if (!priv) {
netdev_err(dev->net, "%s: kzalloc(priv) failed\n", __func__);
return -ENOMEM;
}
dev->driver_priv = priv;
/* Get the EEPROM data*/
ret = asix_read_eeprom_le16(dev, 0x17, &priv->EepromData);
if (ret < 0)
goto err_out;
if (priv->EepromData == 0xffff) {
priv->PhyMode = PHY_MODE_MARVELL;
priv->LedMode = 0;
priv->UseGpio0 = 1;
} else {
priv->PhyMode = (u8)(priv->EepromData & EEPROMMASK);
priv->LedMode = (u8)(priv->EepromData >> 8);
if (priv->LedMode == 6) /* for buffalo new (use gpio2) */
priv->LedMode = 1;
else if (priv->LedMode == 1)
priv->BuffaloOld = 1;
if (priv->EepromData & 0x80)
priv->UseGpio0 = 0; /* MARVEL se and other */
else
priv->UseGpio0 = 1; /* cameo */
}
if (priv->UseGpio0) {
if (priv->PhyMode == PHY_MODE_MARVELL) {
ret = asix_write_gpio(dev, 25,
AXGPIOS_GPO0EN | AXGPIOS_RSE);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 15,
AXGPIOS_GPO2 | AXGPIOS_GPO2EN |
AXGPIOS_GPO0EN);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 245,
AXGPIOS_GPO2EN | AXGPIOS_GPO0EN);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 0,
AXGPIOS_GPO2 | AXGPIOS_GPO2EN |
AXGPIOS_GPO0EN);
if (ret)
goto err_out;
} else { /* vitesse */
ret = asix_write_gpio(dev, 25,
AXGPIOS_RSE | AXGPIOS_GPO0EN |
AXGPIOS_GPO0);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 25,
AXGPIOS_GPO0EN | AXGPIOS_GPO0 |
AXGPIOS_GPO2EN | AXGPIOS_GPO2);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 245,
AXGPIOS_GPO0EN | AXGPIOS_GPO0 |
AXGPIOS_GPO2EN);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 0,
AXGPIOS_GPO0EN | AXGPIOS_GPO0 |
AXGPIOS_GPO2EN | AXGPIOS_GPO2);
if (ret)
goto err_out;
}
} else { /* use gpio1 */
if (priv->BuffaloOld) {
ret = asix_write_gpio(dev, 350,
AXGPIOS_GPO1 | AXGPIOS_GPO1EN |
AXGPIOS_RSE);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 350,
AXGPIOS_GPO1EN);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 0,
AXGPIOS_GPO1EN | AXGPIOS_GPO1);
if (ret)
goto err_out;
} else {
ret = asix_write_gpio(dev, 25,
AXGPIOS_GPO1 | AXGPIOS_GPO1EN |
AXGPIOS_RSE);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 25,
AXGPIOS_GPO1EN | AXGPIOS_GPO1 |
AXGPIOS_GPO2EN | AXGPIOS_GPO2);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 245,
AXGPIOS_GPO1EN | AXGPIOS_GPO1 |
AXGPIOS_GPO2EN);
if (ret)
goto err_out;
ret = asix_write_gpio(dev, 0,
AXGPIOS_GPO1EN | AXGPIOS_GPO1 |
AXGPIOS_GPO2EN | AXGPIOS_GPO2);
if (ret)
goto err_out;
}
}
ret = asix_phy_select(dev, 0);
if (ret < 0)
goto err_out;
ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD | AX_SWRESET_PRL, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: SW_RESET failed\n", __func__);
goto err_out;
}
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL, 0, 0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: RX_CTL failed\n", __func__);
goto err_out;
}
/* Get the MAC address */
ret = asix_read_mac(dev, AX88772_CMD_READ_NODE_ID);
if (ret < 0)
goto err_out;
ret = ax88178_phy_init(dev, priv);
if (ret < 0)
goto err_out;
dev->net->netdev_ops = &ax88x72_netdev_ops;
dev->net->ethtool_ops = &ax8817x_ethtool_ops;
/* Register suspend and resume functions */
data->suspend = ax88772_suspend;
data->resume = ax88772_resume;
if (dev->driver_info->flags & FLAG_FRAMING_AX)
dev->rx_urb_size = 16384;
ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
(AX_RX_CTL_MFB | AX_RX_CTL_START | AX_RX_CTL_AB),
0, 0, NULL);
if (ret < 0) {
netdev_err(dev->net, "%s: RX_CTL failed\n", __func__);
goto err_out;
}
printk(KERN_INFO "%s\n", driver_version);
return ret;
err_out:
kfree(priv);
return ret;
}
static void ax88178_unbind(struct usbnet *dev, struct usb_interface *intf)
{
struct ax88178_data *priv = (struct ax88178_data *)dev->driver_priv;
if (priv) {
/* stop MAC operation */
ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL,
AX_RX_CTL_STOP, 0, 0, NULL);
kfree(priv);
}
}
static int ax88772_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
{
u8 *head;
u32 header;
char *packet;
struct sk_buff *ax_skb;
u16 size;
head = (u8 *) skb->data;
memcpy(&header, head, sizeof(header));
le32_to_cpus(&header);
packet = head + sizeof(header);
skb_pull(skb, 4);
while (skb->len > 0) {
if ((short)(header & 0x0000ffff) !=
~((short)((header & 0xffff0000) >> 16))) {
netdev_err(dev->net,
"%s: header length data is error 0x%08x, %d\n",
__func__, header, skb->len);
}
/* get the packet length */
size = (u16) (header & 0x0000ffff);
if ((skb->len) - ((size + 1) & 0xfffe) == 0) {
/* Make sure ip header is aligned on 32-bit boundary */
if (!((unsigned long)skb->data & 0x02)) {
memmove(skb->data - 2, skb->data, size);
skb->data -= 2;
skb_set_tail_pointer(skb, size);
}
skb->truesize = size + sizeof(struct sk_buff);
return 2;
}
if (size > ETH_FRAME_LEN) {
netdev_err(dev->net, "%s: invalid rx length %d\n",
__func__, size);
return 0;
}
ax_skb = skb_clone(skb, GFP_ATOMIC);
if (ax_skb) {
/* Make sure ip header is aligned on 32-bit boundary */
if (!((unsigned long)packet & 0x02)) {
memmove(packet - 2, packet, size);
packet -= 2;
}
ax_skb->data = packet;
skb_set_tail_pointer(ax_skb, size);
ax_skb->truesize = size + sizeof(struct sk_buff);
usbnet_skb_return(dev, ax_skb);
} else {
return 0;
}
skb_pull(skb, (size + 1) & 0xfffe);
if (skb->len == 0)
break;
head = (u8 *) skb->data;
memcpy(&header, head, sizeof(header));
le32_to_cpus(&header);
packet = head + sizeof(header);
skb_pull(skb, 4);
}
if (skb->len < 0) {
netdev_err(dev->net, "%s: invalid rx length %d\n",
__func__, skb->len);
return 0;
}
return 1;
}
static struct sk_buff *ax88772_tx_fixup(struct usbnet *dev,
struct sk_buff *skb, gfp_t flags)
{
int padlen = ((skb->len + 4) % 512) ? 0 : 4;
u32 packet_len;
u32 padbytes = 0xffff0000;
int headroom = skb_headroom(skb);
int tailroom = skb_tailroom(skb);
if ((!skb_cloned(skb))
&& ((headroom + tailroom) >= (4 + padlen))) {
if ((headroom < 4) || (tailroom < padlen)) {
skb->data = memmove(skb->head + 4, skb->data, skb->len);
skb_set_tail_pointer(skb, skb->len);
}
} else {
struct sk_buff *skb2;
skb2 = skb_copy_expand(skb, 4, padlen, flags);
dev_kfree_skb_any(skb);
skb = skb2;
if (!skb)
return NULL;
}
skb_push(skb, 4);
packet_len = (((skb->len - 4) ^ 0x0000ffff) << 16) + (skb->len - 4);
cpu_to_le32s(&packet_len);
skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
if ((skb->len % 512) == 0) {
cpu_to_le32s(&padbytes);
memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
skb_put(skb, sizeof(padbytes));
}
return skb;
}
static void
ax88772b_rx_checksum(struct sk_buff *skb, struct ax88772b_rx_header *rx_hdr)
{
skb->ip_summed = CHECKSUM_NONE;
/* checksum error bit is set */
if (rx_hdr->l3_csum_err || rx_hdr->l4_csum_err)
return;
/* It must be a TCP or UDP packet with a valid checksum */
if ((rx_hdr->l4_type == AX_RXHDR_L4_TYPE_TCP) ||
(rx_hdr->l4_type == AX_RXHDR_L4_TYPE_UDP)) {
skb->ip_summed = CHECKSUM_UNNECESSARY;
}
}
static int ax88772b_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
{
struct ax88772b_rx_header rx_hdr;
struct sk_buff *ax_skb;
struct ax88772b_data *priv = (struct ax88772b_data *)dev->driver_priv;
while (skb->len > 0) {
memcpy(&rx_hdr, skb->data, sizeof(struct ax88772b_rx_header));
if ((short)rx_hdr.len != (~((short)rx_hdr.len_bar) & 0x7FF))
return 0;
if (rx_hdr.len > (ETH_FRAME_LEN + 4)) {
netdev_err(dev->net, "%s: invalid rx length %d\n",
__func__, rx_hdr.len);
return 0;
}
if (skb->len - ((rx_hdr.len +
sizeof(struct ax88772b_rx_header) + 3) &
0xfffc) == 0) {
skb_pull(skb, sizeof(struct ax88772b_rx_header));
skb->len = rx_hdr.len;
skb_set_tail_pointer(skb, rx_hdr.len);
skb->truesize = rx_hdr.len + sizeof(struct sk_buff);
if (priv->checksum & AX_RX_CHECKSUM)
ax88772b_rx_checksum(skb, &rx_hdr);
return 2;
}
ax_skb = skb_clone(skb, GFP_ATOMIC);
if (ax_skb) {
ax_skb->len = rx_hdr.len;
ax_skb->data = skb->data +
sizeof(struct ax88772b_rx_header);
skb_set_tail_pointer(ax_skb, rx_hdr.len);
ax_skb->truesize = rx_hdr.len + sizeof(struct sk_buff);
if (priv->checksum & AX_RX_CHECKSUM)
ax88772b_rx_checksum(ax_skb, &rx_hdr);
usbnet_skb_return(dev, ax_skb);
} else {
return 0;
}
skb_pull(skb, ((rx_hdr.len +
sizeof(struct ax88772b_rx_header) + 3)
& 0xfffc));
}
if (skb->len < 0) {
netdev_err(dev->net, "%s: invalid rx length %d\n",
__func__, skb->len);
return 0;
}
return 1;
}
static struct sk_buff *
ax88772b_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags)
{
int padlen = ((skb->len + 4) % 512) ? 0 : 4;
u32 packet_len;
u32 padbytes = 0xffff0000;
int headroom = skb_headroom(skb);
int tailroom = skb_tailroom(skb);
if ((!skb_cloned(skb))
&& ((headroom + tailroom) >= (4 + padlen))) {
if ((headroom < 4) || (tailroom < padlen)) {
skb->data = memmove(skb->head + 4, skb->data, skb->len);
skb_set_tail_pointer(skb, skb->len);
}
} else {
struct sk_buff *skb2;
skb2 = skb_copy_expand(skb, 4, padlen, flags);
dev_kfree_skb_any(skb);
skb = skb2;
if (!skb)
return NULL;
}
skb_push(skb, 4);
packet_len = (((skb->len - 4) ^ 0x0000ffff) << 16) + (skb->len - 4);
cpu_to_le32s(&packet_len);
skb_copy_to_linear_data(skb, &packet_len, sizeof(packet_len));
if ((skb->len % 512) == 0) {
cpu_to_le32s(&padbytes);
memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes));
skb_put(skb, sizeof(padbytes));
}
return skb;
}
static const u8 ChkCntSel[6][3] = {
{12, 23, 31},
{12, 31, 23},
{23, 31, 12},
{23, 12, 31},
{31, 12, 23},
{31, 23, 12}
};
static void ax88772_link_reset(struct work_struct *work)
{
struct ax88772_data *priv = container_of(work,
struct ax88772_data, check_link);
struct usbnet *dev = priv->dev;
if (priv->Event == AX_SET_RX_CFG) {
u16 bmcr;
u16 mode;
priv->Event = AX_NOP;
mode = AX88772_MEDIUM_DEFAULT;
bmcr = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MII_BMCR);
if (!(bmcr & BMCR_FULLDPLX))
mode &= ~AX88772_MEDIUM_FULL_DUPLEX;
if (!(bmcr & BMCR_SPEED100))
mode &= ~AX88772_MEDIUM_100MB;
asix_write_medium_mode(dev, mode);
return;
}
switch (priv->Event) {
case WAIT_AUTONEG_COMPLETE:
if (jiffies > (priv->autoneg_start + 5 * HZ)) {
priv->Event = PHY_POWER_DOWN;
priv->TickToExpire = 23;
}
break;
case PHY_POWER_DOWN:
if (priv->TickToExpire == 23) {
/* Set Phy Power Down */
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD,
0, 0, NULL);
--priv->TickToExpire;
} else if (--priv->TickToExpire == 0) {
/* Set Phy Power Up */
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL, 0, 0, NULL);
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD | AX_SWRESET_IPRL, 0, 0, NULL);
usleep_range(10000, 20000);
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL, 0, 0, NULL);
msleep(60);
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_CLEAR, 0, 0, NULL);
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPRL, 0, 0, NULL);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id,
MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA |
ADVERTISE_PAUSE_CAP);
mii_nway_restart(&dev->mii);
priv->Event = PHY_POWER_UP;
priv->TickToExpire = 47;
}
break;
case PHY_POWER_UP:
if (--priv->TickToExpire == 0) {
priv->Event = PHY_POWER_DOWN;
priv->TickToExpire = 23;
}
break;
default:
break;
}
return;
}
static void ax88772a_link_reset(struct work_struct *work)
{
struct ax88772a_data *priv = container_of(work,
struct ax88772a_data, check_link);
struct usbnet *dev = priv->dev;
int PowSave = (priv->EepromData >> 14);
u16 phy_reg;
if (priv->Event == AX_SET_RX_CFG) {
u16 bmcr;
u16 mode;
priv->Event = AX_NOP;
mode = AX88772_MEDIUM_DEFAULT;
bmcr = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MII_BMCR);
if (!(bmcr & BMCR_FULLDPLX))
mode &= ~AX88772_MEDIUM_FULL_DUPLEX;
if (!(bmcr & BMCR_SPEED100))
mode &= ~AX88772_MEDIUM_100MB;
asix_write_medium_mode(dev, mode);
return;
}
switch (priv->Event) {
case WAIT_AUTONEG_COMPLETE:
if (jiffies > (priv->autoneg_start + 5 * HZ)) {
priv->Event = CHK_CABLE_EXIST;
priv->TickToExpire = 14;
}
break;
case CHK_CABLE_EXIST:
phy_reg = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, 0x12);
if ((phy_reg != 0x8012) && (phy_reg != 0x8013)) {
ax8817x_mdio_write_le(dev->net,
dev->mii.phy_id, 0x16, 0x4040);
mii_nway_restart(&dev->mii);
priv->Event = CHK_CABLE_STATUS;
priv->TickToExpire = 31;
} else if (--priv->TickToExpire == 0) {
mii_nway_restart(&dev->mii);
priv->Event = CHK_CABLE_EXIST_AGAIN;
if (PowSave == 0x03) {
priv->TickToExpire = 47;
} else if (PowSave == 0x01) {
priv->DlyIndex = (u8)(jiffies % 6);
priv->DlySel = 0;
priv->TickToExpire =
ChkCntSel[priv->DlyIndex][priv->DlySel];
}
}
break;
case CHK_CABLE_EXIST_AGAIN:
/* if cable disconnected */
phy_reg = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, 0x12);
if ((phy_reg != 0x8012) && (phy_reg != 0x8013)) {
mii_nway_restart(&dev->mii);
priv->Event = CHK_CABLE_STATUS;
priv->TickToExpire = 31;
} else if (--priv->TickToExpire == 0) {
/* Power down PHY */
ax8817x_write_cmd(dev, AX_CMD_SW_RESET,
AX_SWRESET_IPPD,
0, 0, NULL);
priv->Event = PHY_POWER_DOWN;
if (PowSave == 0x03)
priv->TickToExpire = 23;
else if (PowSave == 0x01)
priv->TickToExpire = 31;
}
break;
case PHY_POWER_DOWN:
if (--priv->TickToExpire == 0)
priv->Event = PHY_POWER_UP;
break;
case CHK_CABLE_STATUS:
if (--priv->TickToExpire == 0) {
ax8817x_mdio_write_le(dev->net,
dev->mii.phy_id, 0x16, 0x4040);
mii_nway_restart(&dev->mii);
priv->Event = CHK_CABLE_EXIST_AGAIN;
if (PowSave == 0x03) {
priv->TickToExpire = 47;
} else if (PowSave == 0x01) {
priv->DlyIndex = (u8)(jiffies % 6);
priv->DlySel = 0;
priv->TickToExpire =
ChkCntSel[priv->DlyIndex][priv->DlySel];
}
}
break;
case PHY_POWER_UP:
ax88772a_phy_powerup(dev);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
mii_nway_restart(&dev->mii);
priv->Event = CHK_CABLE_EXIST_AGAIN;
if (PowSave == 0x03) {
priv->TickToExpire = 47;
} else if (PowSave == 0x01) {
if (++priv->DlySel >= 3) {
priv->DlyIndex = (u8)(jiffies % 6);
priv->DlySel = 0;
}
priv->TickToExpire =
ChkCntSel[priv->DlyIndex][priv->DlySel];
}
break;
default:
break;
}
return;
}
static void ax88772b_link_reset(struct work_struct *work)
{
struct ax88772b_data *priv = container_of(work,
struct ax88772b_data, check_link);
struct usbnet *dev = priv->dev;
switch (priv->Event) {
case AX_SET_RX_CFG:
{
u16 bmcr = ax8817x_mdio_read_le(dev->net,
dev->mii.phy_id, MII_BMCR);
u16 mode = AX88772_MEDIUM_DEFAULT;
if (!(bmcr & BMCR_FULLDPLX))
mode &= ~AX88772_MEDIUM_FULL_DUPLEX;
if (!(bmcr & BMCR_SPEED100))
mode &= ~AX88772_MEDIUM_100MB;
asix_write_medium_mode(dev, mode);
break;
}
case PHY_POWER_UP:
{
u16 tmp16;
ax88772a_phy_powerup(dev);
tmp16 = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, 0x12);
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, 0x12,
((tmp16 & 0xFF9F) | 0x0040));
ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE,
ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP);
break;
}
default:
break;
}
priv->Event = AX_NOP;
return;
}
static int ax88178_set_media(struct usbnet *dev)
{
int ret;
struct ax88178_data *priv = (struct ax88178_data *)dev->driver_priv;
int media;
media = ax88178_media_check(dev, priv);
if (media < 0)
return media;
ret = asix_write_medium_mode(dev, media);
if (ret < 0)
return ret;
return 0;
}
static int ax88178_link_reset(struct usbnet *dev)
{
return ax88178_set_media(dev);
}
static int ax_suspend(struct usb_interface *intf,
pm_message_t message)
{
struct usbnet *dev = usb_get_intfdata(intf);
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
return data->suspend(intf, message);
}
static int ax_resume(struct usb_interface *intf)
{
struct usbnet *dev = usb_get_intfdata(intf);
struct ax8817x_data *data = (struct ax8817x_data *)&dev->data;
return data->resume(intf);
}
static const struct driver_info ax88178_info = {
.description = "ASIX AX88178 USB 2.0 Ethernet",
.bind = ax88178_bind,
.unbind = ax88178_unbind,
.status = ax88178_status,
.link_reset = ax88178_link_reset,
.reset = ax88178_link_reset,
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
.rx_fixup = ax88772_rx_fixup,
.tx_fixup = ax88772_tx_fixup,
};
static const struct driver_info belkin178_info = {
.description = "Belkin Gigabit USB 2.0 Network Adapter",
.bind = ax88178_bind,
.unbind = ax88178_unbind,
.status = ax8817x_status,
.link_reset = ax88178_link_reset,
.reset = ax88178_link_reset,
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
.rx_fixup = ax88772_rx_fixup,
.tx_fixup = ax88772_tx_fixup,
};
static const struct driver_info ax8817x_info = {
.description = "ASIX AX8817x USB 2.0 Ethernet",
.bind = ax8817x_bind,
.status = ax8817x_status,
.link_reset = ax88172_link_reset,
.reset = ax88172_link_reset,
.flags = FLAG_ETHER,
};
static const struct driver_info dlink_dub_e100_info = {
.description = "DLink DUB-E100 USB Ethernet",
.bind = ax8817x_bind,
.status = ax8817x_status,
.link_reset = ax88172_link_reset,
.reset = ax88172_link_reset,
.flags = FLAG_ETHER,
};
static const struct driver_info netgear_fa120_info = {
.description = "Netgear FA-120 USB Ethernet",
.bind = ax8817x_bind,
.status = ax8817x_status,
.link_reset = ax88172_link_reset,
.reset = ax88172_link_reset,
.flags = FLAG_ETHER,
};
static const struct driver_info hawking_uf200_info = {
.description = "Hawking UF200 USB Ethernet",
.bind = ax8817x_bind,
.status = ax8817x_status,
.link_reset = ax88172_link_reset,
.reset = ax88172_link_reset,
.flags = FLAG_ETHER,
};
static const struct driver_info ax88772_info = {
.description = "ASIX AX88772 USB 2.0 Ethernet",
.bind = ax88772_bind,
.unbind = ax88772_unbind,
.status = ax88772_status,
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
.rx_fixup = ax88772_rx_fixup,
.tx_fixup = ax88772_tx_fixup,
};
static const struct driver_info dlink_dub_e100b_info = {
.description = "D-Link DUB-E100 USB 2.0 Fast Ethernet Adapter",
.bind = ax88772_bind,
.unbind = ax88772_unbind,
.status = ax88772_status,
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
.rx_fixup = ax88772_rx_fixup,
.tx_fixup = ax88772_tx_fixup,
};
static const struct driver_info ax88772a_info = {
.description = "ASIX AX88772A USB 2.0 Ethernet",
.bind = ax88772a_bind,
.unbind = ax88772a_unbind,
.status = ax88772a_status,
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
.rx_fixup = ax88772_rx_fixup,
.tx_fixup = ax88772_tx_fixup,
};
static const struct driver_info ax88772b_info = {
.description = "ASIX AX88772B USB 2.0 Ethernet",
.bind = ax88772b_bind,
.unbind = ax88772b_unbind,
.status = ax88772b_status,
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
.rx_fixup = ax88772b_rx_fixup,
.tx_fixup = ax88772b_tx_fixup,
};
static const struct usb_device_id products[] = {
{
/* 88178 */
USB_DEVICE(0x0b95, 0x1780),
.driver_info = (unsigned long) &ax88178_info,
}, {
/* 88178 for billianton linksys */
USB_DEVICE(0x077b, 0x2226),
.driver_info = (unsigned long) &ax88178_info,
}, {
/* ABOCOM for linksys */
USB_DEVICE(0x1737, 0x0039),
.driver_info = (unsigned long) &ax88178_info,
}, {
/* ABOCOM for pci */
USB_DEVICE(0x14ea, 0xab11),
.driver_info = (unsigned long) &ax88178_info,
}, {
/* Belkin */
USB_DEVICE(0x050d, 0x5055),
.driver_info = (unsigned long) &belkin178_info,
}, {
/* Linksys USB200M */
USB_DEVICE(0x077b, 0x2226),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* Netgear FA120 */
USB_DEVICE(0x0846, 0x1040),
.driver_info = (unsigned long) &netgear_fa120_info,
}, {
/* DLink DUB-E100 */
USB_DEVICE(0x2001, 0x1a00),
.driver_info = (unsigned long) &dlink_dub_e100_info,
}, {
/* DLink DUB-E100B */
USB_DEVICE(0x2001, 0x3c05),
.driver_info = (unsigned long) &dlink_dub_e100b_info,
}, {
/* DLink DUB-E100B */
USB_DEVICE(0x07d1, 0x3c05),
.driver_info = (unsigned long) &dlink_dub_e100b_info,
}, {
/* Intellinet, ST Lab USB Ethernet */
USB_DEVICE(0x0b95, 0x1720),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* Hawking UF200, TrendNet TU2-ET100 */
USB_DEVICE(0x07b8, 0x420a),
.driver_info = (unsigned long) &hawking_uf200_info,
}, {
/* Billionton Systems, USB2AR */
USB_DEVICE(0x08dd, 0x90ff),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* ATEN UC210T */
USB_DEVICE(0x0557, 0x2009),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* Buffalo LUA-U2-KTX */
USB_DEVICE(0x0411, 0x003d),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter" */
USB_DEVICE(0x6189, 0x182d),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* corega FEther USB2-TX */
USB_DEVICE(0x07aa, 0x0017),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* Surecom EP-1427X-2 */
USB_DEVICE(0x1189, 0x0893),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* goodway corp usb gwusb2e */
USB_DEVICE(0x1631, 0x6200),
.driver_info = (unsigned long) &ax8817x_info,
}, {
/* ASIX AX88772 10/100 */
USB_DEVICE(0x0b95, 0x7720),
.driver_info = (unsigned long) &ax88772_info,
}, {
/* ASIX AX88772 10/100 */
USB_DEVICE(0x125E, 0x180D),
.driver_info = (unsigned long) &ax88772_info,
}, {
/* ASIX AX88772A 10/100 */
USB_DEVICE(0x0b95, 0x772A),
.driver_info = (unsigned long) &ax88772a_info,
}, {
/* ASIX AX88772A 10/100 */
USB_DEVICE(0x0db0, 0xA877),
.driver_info = (unsigned long) &ax88772a_info,
}, {
/* ASIX AX88772A 10/100 */
USB_DEVICE(0x0421, 0x772A),
.driver_info = (unsigned long) &ax88772a_info,
}, {
/* Linksys 200M */
USB_DEVICE(0x13B1, 0x0018),
.driver_info = (unsigned long) &ax88772a_info,
}, {
USB_DEVICE(0x05ac, 0x1402),
.driver_info = (unsigned long) &ax88772a_info,
}, {
/* ASIX AX88772B 10/100 */
USB_DEVICE(0x0b95, 0x772B),
.driver_info = (unsigned long) &ax88772b_info,
}, {
/* ASIX AX88772B 10/100 */
USB_DEVICE(0x0b95, 0x7E2B),
.driver_info = (unsigned long) &ax88772b_info,
},
{ }, /* END */
};
MODULE_DEVICE_TABLE(usb, products);
static struct usb_driver asix_driver = {
.name = driver_name,
.id_table = products,
.probe = usbnet_probe,
.suspend = ax_suspend,
.resume = ax_resume,
.disconnect = usbnet_disconnect,
};
static int __init asix_init(void)
{
return usb_register(&asix_driver);
}
module_init(asix_init);
static void __exit asix_exit(void)
{
usb_deregister(&asix_driver);
}
module_exit(asix_exit);
MODULE_AUTHOR("David Hollis");
MODULE_DESCRIPTION("ASIX AX8817X based USB 2.0 Ethernet Devices");
MODULE_LICENSE("GPL");
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/