mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-26 02:20:53 +07:00
7a97856e27
Use usbnet_link_change to handle link change centrally. Signed-off-by: Ming Lei <ming.lei@canonical.com> Signed-off-by: David S. Miller <davem@davemloft.net>
1445 lines
37 KiB
C
1445 lines
37 KiB
C
/*
|
|
* ASIX AX88179/178A USB 3.0/2.0 to Gigabit Ethernet Devices
|
|
*
|
|
* Copyright (C) 2011-2013 ASIX
|
|
*
|
|
* 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/etherdevice.h>
|
|
#include <linux/mii.h>
|
|
#include <linux/usb.h>
|
|
#include <linux/crc32.h>
|
|
#include <linux/usb/usbnet.h>
|
|
|
|
#define AX88179_PHY_ID 0x03
|
|
#define AX_EEPROM_LEN 0x100
|
|
#define AX88179_EEPROM_MAGIC 0x17900b95
|
|
#define AX_MCAST_FLTSIZE 8
|
|
#define AX_MAX_MCAST 64
|
|
#define AX_INT_PPLS_LINK ((u32)BIT(16))
|
|
#define AX_RXHDR_L4_TYPE_MASK 0x1c
|
|
#define AX_RXHDR_L4_TYPE_UDP 4
|
|
#define AX_RXHDR_L4_TYPE_TCP 16
|
|
#define AX_RXHDR_L3CSUM_ERR 2
|
|
#define AX_RXHDR_L4CSUM_ERR 1
|
|
#define AX_RXHDR_CRC_ERR ((u32)BIT(31))
|
|
#define AX_RXHDR_DROP_ERR ((u32)BIT(30))
|
|
#define AX_ACCESS_MAC 0x01
|
|
#define AX_ACCESS_PHY 0x02
|
|
#define AX_ACCESS_EEPROM 0x04
|
|
#define AX_ACCESS_EFUS 0x05
|
|
#define AX_PAUSE_WATERLVL_HIGH 0x54
|
|
#define AX_PAUSE_WATERLVL_LOW 0x55
|
|
|
|
#define PHYSICAL_LINK_STATUS 0x02
|
|
#define AX_USB_SS 0x04
|
|
#define AX_USB_HS 0x02
|
|
|
|
#define GENERAL_STATUS 0x03
|
|
/* Check AX88179 version. UA1:Bit2 = 0, UA2:Bit2 = 1 */
|
|
#define AX_SECLD 0x04
|
|
|
|
#define AX_SROM_ADDR 0x07
|
|
#define AX_SROM_CMD 0x0a
|
|
#define EEP_RD 0x04
|
|
#define EEP_BUSY 0x10
|
|
|
|
#define AX_SROM_DATA_LOW 0x08
|
|
#define AX_SROM_DATA_HIGH 0x09
|
|
|
|
#define AX_RX_CTL 0x0b
|
|
#define AX_RX_CTL_DROPCRCERR 0x0100
|
|
#define AX_RX_CTL_IPE 0x0200
|
|
#define AX_RX_CTL_START 0x0080
|
|
#define AX_RX_CTL_AP 0x0020
|
|
#define AX_RX_CTL_AM 0x0010
|
|
#define AX_RX_CTL_AB 0x0008
|
|
#define AX_RX_CTL_AMALL 0x0002
|
|
#define AX_RX_CTL_PRO 0x0001
|
|
#define AX_RX_CTL_STOP 0x0000
|
|
|
|
#define AX_NODE_ID 0x10
|
|
#define AX_MULFLTARY 0x16
|
|
|
|
#define AX_MEDIUM_STATUS_MODE 0x22
|
|
#define AX_MEDIUM_GIGAMODE 0x01
|
|
#define AX_MEDIUM_FULL_DUPLEX 0x02
|
|
#define AX_MEDIUM_ALWAYS_ONE 0x04
|
|
#define AX_MEDIUM_EN_125MHZ 0x08
|
|
#define AX_MEDIUM_RXFLOW_CTRLEN 0x10
|
|
#define AX_MEDIUM_TXFLOW_CTRLEN 0x20
|
|
#define AX_MEDIUM_RECEIVE_EN 0x100
|
|
#define AX_MEDIUM_PS 0x200
|
|
#define AX_MEDIUM_JUMBO_EN 0x8040
|
|
|
|
#define AX_MONITOR_MOD 0x24
|
|
#define AX_MONITOR_MODE_RWLC 0x02
|
|
#define AX_MONITOR_MODE_RWMP 0x04
|
|
#define AX_MONITOR_MODE_PMEPOL 0x20
|
|
#define AX_MONITOR_MODE_PMETYPE 0x40
|
|
|
|
#define AX_GPIO_CTRL 0x25
|
|
#define AX_GPIO_CTRL_GPIO3EN 0x80
|
|
#define AX_GPIO_CTRL_GPIO2EN 0x40
|
|
#define AX_GPIO_CTRL_GPIO1EN 0x20
|
|
|
|
#define AX_PHYPWR_RSTCTL 0x26
|
|
#define AX_PHYPWR_RSTCTL_BZ 0x0010
|
|
#define AX_PHYPWR_RSTCTL_IPRL 0x0020
|
|
#define AX_PHYPWR_RSTCTL_AT 0x1000
|
|
|
|
#define AX_RX_BULKIN_QCTRL 0x2e
|
|
#define AX_CLK_SELECT 0x33
|
|
#define AX_CLK_SELECT_BCS 0x01
|
|
#define AX_CLK_SELECT_ACS 0x02
|
|
#define AX_CLK_SELECT_ULR 0x08
|
|
|
|
#define AX_RXCOE_CTL 0x34
|
|
#define AX_RXCOE_IP 0x01
|
|
#define AX_RXCOE_TCP 0x02
|
|
#define AX_RXCOE_UDP 0x04
|
|
#define AX_RXCOE_TCPV6 0x20
|
|
#define AX_RXCOE_UDPV6 0x40
|
|
|
|
#define AX_TXCOE_CTL 0x35
|
|
#define AX_TXCOE_IP 0x01
|
|
#define AX_TXCOE_TCP 0x02
|
|
#define AX_TXCOE_UDP 0x04
|
|
#define AX_TXCOE_TCPV6 0x20
|
|
#define AX_TXCOE_UDPV6 0x40
|
|
|
|
#define AX_LEDCTRL 0x73
|
|
|
|
#define GMII_PHY_PHYSR 0x11
|
|
#define GMII_PHY_PHYSR_SMASK 0xc000
|
|
#define GMII_PHY_PHYSR_GIGA 0x8000
|
|
#define GMII_PHY_PHYSR_100 0x4000
|
|
#define GMII_PHY_PHYSR_FULL 0x2000
|
|
#define GMII_PHY_PHYSR_LINK 0x400
|
|
|
|
#define GMII_LED_ACT 0x1a
|
|
#define GMII_LED_ACTIVE_MASK 0xff8f
|
|
#define GMII_LED0_ACTIVE BIT(4)
|
|
#define GMII_LED1_ACTIVE BIT(5)
|
|
#define GMII_LED2_ACTIVE BIT(6)
|
|
|
|
#define GMII_LED_LINK 0x1c
|
|
#define GMII_LED_LINK_MASK 0xf888
|
|
#define GMII_LED0_LINK_10 BIT(0)
|
|
#define GMII_LED0_LINK_100 BIT(1)
|
|
#define GMII_LED0_LINK_1000 BIT(2)
|
|
#define GMII_LED1_LINK_10 BIT(4)
|
|
#define GMII_LED1_LINK_100 BIT(5)
|
|
#define GMII_LED1_LINK_1000 BIT(6)
|
|
#define GMII_LED2_LINK_10 BIT(8)
|
|
#define GMII_LED2_LINK_100 BIT(9)
|
|
#define GMII_LED2_LINK_1000 BIT(10)
|
|
#define LED0_ACTIVE BIT(0)
|
|
#define LED0_LINK_10 BIT(1)
|
|
#define LED0_LINK_100 BIT(2)
|
|
#define LED0_LINK_1000 BIT(3)
|
|
#define LED0_FD BIT(4)
|
|
#define LED0_USB3_MASK 0x001f
|
|
#define LED1_ACTIVE BIT(5)
|
|
#define LED1_LINK_10 BIT(6)
|
|
#define LED1_LINK_100 BIT(7)
|
|
#define LED1_LINK_1000 BIT(8)
|
|
#define LED1_FD BIT(9)
|
|
#define LED1_USB3_MASK 0x03e0
|
|
#define LED2_ACTIVE BIT(10)
|
|
#define LED2_LINK_1000 BIT(13)
|
|
#define LED2_LINK_100 BIT(12)
|
|
#define LED2_LINK_10 BIT(11)
|
|
#define LED2_FD BIT(14)
|
|
#define LED_VALID BIT(15)
|
|
#define LED2_USB3_MASK 0x7c00
|
|
|
|
#define GMII_PHYPAGE 0x1e
|
|
#define GMII_PHY_PAGE_SELECT 0x1f
|
|
#define GMII_PHY_PGSEL_EXT 0x0007
|
|
#define GMII_PHY_PGSEL_PAGE0 0x0000
|
|
|
|
struct ax88179_data {
|
|
u16 rxctl;
|
|
u16 reserved;
|
|
};
|
|
|
|
struct ax88179_int_data {
|
|
__le32 intdata1;
|
|
__le32 intdata2;
|
|
};
|
|
|
|
static const struct {
|
|
unsigned char ctrl, timer_l, timer_h, size, ifg;
|
|
} AX88179_BULKIN_SIZE[] = {
|
|
{7, 0x4f, 0, 0x12, 0xff},
|
|
{7, 0x20, 3, 0x16, 0xff},
|
|
{7, 0xae, 7, 0x18, 0xff},
|
|
{7, 0xcc, 0x4c, 0x18, 8},
|
|
};
|
|
|
|
static int __ax88179_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
|
|
u16 size, void *data, int in_pm)
|
|
{
|
|
int ret;
|
|
int (*fn)(struct usbnet *, u8, u8, u16, u16, void *, u16);
|
|
|
|
BUG_ON(!dev);
|
|
|
|
if (!in_pm)
|
|
fn = usbnet_read_cmd;
|
|
else
|
|
fn = usbnet_read_cmd_nopm;
|
|
|
|
ret = fn(dev, cmd, USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
value, index, data, size);
|
|
|
|
if (unlikely(ret < 0))
|
|
netdev_warn(dev->net, "Failed to read reg index 0x%04x: %d\n",
|
|
index, ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __ax88179_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
|
|
u16 size, void *data, int in_pm)
|
|
{
|
|
int ret;
|
|
int (*fn)(struct usbnet *, u8, u8, u16, u16, const void *, u16);
|
|
|
|
BUG_ON(!dev);
|
|
|
|
if (!in_pm)
|
|
fn = usbnet_write_cmd;
|
|
else
|
|
fn = usbnet_write_cmd_nopm;
|
|
|
|
ret = fn(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
|
|
value, index, data, size);
|
|
|
|
if (unlikely(ret < 0))
|
|
netdev_warn(dev->net, "Failed to write reg index 0x%04x: %d\n",
|
|
index, ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void ax88179_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value,
|
|
u16 index, u16 size, void *data)
|
|
{
|
|
u16 buf;
|
|
|
|
if (2 == size) {
|
|
buf = *((u16 *)data);
|
|
cpu_to_le16s(&buf);
|
|
usbnet_write_cmd_async(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |
|
|
USB_RECIP_DEVICE, value, index, &buf,
|
|
size);
|
|
} else {
|
|
usbnet_write_cmd_async(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |
|
|
USB_RECIP_DEVICE, value, index, data,
|
|
size);
|
|
}
|
|
}
|
|
|
|
static int ax88179_read_cmd_nopm(struct usbnet *dev, u8 cmd, u16 value,
|
|
u16 index, u16 size, void *data)
|
|
{
|
|
int ret;
|
|
|
|
if (2 == size) {
|
|
u16 buf;
|
|
ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 1);
|
|
le16_to_cpus(&buf);
|
|
*((u16 *)data) = buf;
|
|
} else if (4 == size) {
|
|
u32 buf;
|
|
ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 1);
|
|
le32_to_cpus(&buf);
|
|
*((u32 *)data) = buf;
|
|
} else {
|
|
ret = __ax88179_read_cmd(dev, cmd, value, index, size, data, 1);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ax88179_write_cmd_nopm(struct usbnet *dev, u8 cmd, u16 value,
|
|
u16 index, u16 size, void *data)
|
|
{
|
|
int ret;
|
|
|
|
if (2 == size) {
|
|
u16 buf;
|
|
buf = *((u16 *)data);
|
|
cpu_to_le16s(&buf);
|
|
ret = __ax88179_write_cmd(dev, cmd, value, index,
|
|
size, &buf, 1);
|
|
} else {
|
|
ret = __ax88179_write_cmd(dev, cmd, value, index,
|
|
size, data, 1);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ax88179_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
|
|
u16 size, void *data)
|
|
{
|
|
int ret;
|
|
|
|
if (2 == size) {
|
|
u16 buf;
|
|
ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 0);
|
|
le16_to_cpus(&buf);
|
|
*((u16 *)data) = buf;
|
|
} else if (4 == size) {
|
|
u32 buf;
|
|
ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 0);
|
|
le32_to_cpus(&buf);
|
|
*((u32 *)data) = buf;
|
|
} else {
|
|
ret = __ax88179_read_cmd(dev, cmd, value, index, size, data, 0);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ax88179_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
|
|
u16 size, void *data)
|
|
{
|
|
int ret;
|
|
|
|
if (2 == size) {
|
|
u16 buf;
|
|
buf = *((u16 *)data);
|
|
cpu_to_le16s(&buf);
|
|
ret = __ax88179_write_cmd(dev, cmd, value, index,
|
|
size, &buf, 0);
|
|
} else {
|
|
ret = __ax88179_write_cmd(dev, cmd, value, index,
|
|
size, data, 0);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void ax88179_status(struct usbnet *dev, struct urb *urb)
|
|
{
|
|
struct ax88179_int_data *event;
|
|
u32 link;
|
|
|
|
if (urb->actual_length < 8)
|
|
return;
|
|
|
|
event = urb->transfer_buffer;
|
|
le32_to_cpus((void *)&event->intdata1);
|
|
|
|
link = (((__force u32)event->intdata1) & AX_INT_PPLS_LINK) >> 16;
|
|
|
|
if (netif_carrier_ok(dev->net) != link) {
|
|
usbnet_link_change(dev, link, 1);
|
|
netdev_info(dev->net, "ax88179 - Link status is: %d\n", link);
|
|
}
|
|
}
|
|
|
|
static int ax88179_mdio_read(struct net_device *netdev, int phy_id, int loc)
|
|
{
|
|
struct usbnet *dev = netdev_priv(netdev);
|
|
u16 res;
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_PHY, phy_id, (__u16)loc, 2, &res);
|
|
return res;
|
|
}
|
|
|
|
static void ax88179_mdio_write(struct net_device *netdev, int phy_id, int loc,
|
|
int val)
|
|
{
|
|
struct usbnet *dev = netdev_priv(netdev);
|
|
u16 res = (u16) val;
|
|
|
|
ax88179_write_cmd(dev, AX_ACCESS_PHY, phy_id, (__u16)loc, 2, &res);
|
|
}
|
|
|
|
static int ax88179_suspend(struct usb_interface *intf, pm_message_t message)
|
|
{
|
|
struct usbnet *dev = usb_get_intfdata(intf);
|
|
u16 tmp16;
|
|
u8 tmp8;
|
|
|
|
usbnet_suspend(intf, message);
|
|
|
|
/* Disable RX path */
|
|
ax88179_read_cmd_nopm(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
tmp16 &= ~AX_MEDIUM_RECEIVE_EN;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
|
|
/* Force bulk-in zero length */
|
|
ax88179_read_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
|
|
2, 2, &tmp16);
|
|
|
|
tmp16 |= AX_PHYPWR_RSTCTL_BZ | AX_PHYPWR_RSTCTL_IPRL;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
|
|
2, 2, &tmp16);
|
|
|
|
/* change clock */
|
|
tmp8 = 0;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
|
|
|
|
/* Configure RX control register => stop operation */
|
|
tmp16 = AX_RX_CTL_STOP;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &tmp16);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* This function is used to enable the autodetach function. */
|
|
/* This function is determined by offset 0x43 of EEPROM */
|
|
static int ax88179_auto_detach(struct usbnet *dev, int in_pm)
|
|
{
|
|
u16 tmp16;
|
|
u8 tmp8;
|
|
int (*fnr)(struct usbnet *, u8, u16, u16, u16, void *);
|
|
int (*fnw)(struct usbnet *, u8, u16, u16, u16, void *);
|
|
|
|
if (!in_pm) {
|
|
fnr = ax88179_read_cmd;
|
|
fnw = ax88179_write_cmd;
|
|
} else {
|
|
fnr = ax88179_read_cmd_nopm;
|
|
fnw = ax88179_write_cmd_nopm;
|
|
}
|
|
|
|
if (fnr(dev, AX_ACCESS_EEPROM, 0x43, 1, 2, &tmp16) < 0)
|
|
return 0;
|
|
|
|
if ((tmp16 == 0xFFFF) || (!(tmp16 & 0x0100)))
|
|
return 0;
|
|
|
|
/* Enable Auto Detach bit */
|
|
tmp8 = 0;
|
|
fnr(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
|
|
tmp8 |= AX_CLK_SELECT_ULR;
|
|
fnw(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
|
|
|
|
fnr(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, &tmp16);
|
|
tmp16 |= AX_PHYPWR_RSTCTL_AT;
|
|
fnw(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, &tmp16);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_resume(struct usb_interface *intf)
|
|
{
|
|
struct usbnet *dev = usb_get_intfdata(intf);
|
|
u16 tmp16;
|
|
u8 tmp8;
|
|
|
|
usbnet_link_change(dev, 0, 0);
|
|
|
|
/* Power up ethernet PHY */
|
|
tmp16 = 0;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
|
|
2, 2, &tmp16);
|
|
udelay(1000);
|
|
|
|
tmp16 = AX_PHYPWR_RSTCTL_IPRL;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
|
|
2, 2, &tmp16);
|
|
msleep(200);
|
|
|
|
/* Ethernet PHY Auto Detach*/
|
|
ax88179_auto_detach(dev, 1);
|
|
|
|
/* Enable clock */
|
|
ax88179_read_cmd_nopm(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
|
|
tmp8 |= AX_CLK_SELECT_ACS | AX_CLK_SELECT_BCS;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
|
|
msleep(100);
|
|
|
|
/* Configure RX control register => start operation */
|
|
tmp16 = AX_RX_CTL_DROPCRCERR | AX_RX_CTL_IPE | AX_RX_CTL_START |
|
|
AX_RX_CTL_AP | AX_RX_CTL_AMALL | AX_RX_CTL_AB;
|
|
ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &tmp16);
|
|
|
|
return usbnet_resume(intf);
|
|
}
|
|
|
|
static void
|
|
ax88179_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
u8 opt;
|
|
|
|
if (ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD,
|
|
1, 1, &opt) < 0) {
|
|
wolinfo->supported = 0;
|
|
wolinfo->wolopts = 0;
|
|
return;
|
|
}
|
|
|
|
wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
|
|
wolinfo->wolopts = 0;
|
|
if (opt & AX_MONITOR_MODE_RWLC)
|
|
wolinfo->wolopts |= WAKE_PHY;
|
|
if (opt & AX_MONITOR_MODE_RWMP)
|
|
wolinfo->wolopts |= WAKE_MAGIC;
|
|
}
|
|
|
|
static int
|
|
ax88179_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
u8 opt = 0;
|
|
|
|
if (wolinfo->wolopts & WAKE_PHY)
|
|
opt |= AX_MONITOR_MODE_RWLC;
|
|
if (wolinfo->wolopts & WAKE_MAGIC)
|
|
opt |= AX_MONITOR_MODE_RWMP;
|
|
|
|
if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD,
|
|
1, 1, &opt) < 0)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_get_eeprom_len(struct net_device *net)
|
|
{
|
|
return AX_EEPROM_LEN;
|
|
}
|
|
|
|
static int
|
|
ax88179_get_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
|
|
u8 *data)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
u16 *eeprom_buff;
|
|
int first_word, last_word;
|
|
int i, ret;
|
|
|
|
if (eeprom->len == 0)
|
|
return -EINVAL;
|
|
|
|
eeprom->magic = AX88179_EEPROM_MAGIC;
|
|
|
|
first_word = eeprom->offset >> 1;
|
|
last_word = (eeprom->offset + eeprom->len - 1) >> 1;
|
|
eeprom_buff = kmalloc(sizeof(u16) * (last_word - first_word + 1),
|
|
GFP_KERNEL);
|
|
if (!eeprom_buff)
|
|
return -ENOMEM;
|
|
|
|
/* ax88179/178A returns 2 bytes from eeprom on read */
|
|
for (i = first_word; i <= last_word; i++) {
|
|
ret = __ax88179_read_cmd(dev, AX_ACCESS_EEPROM, i, 1, 2,
|
|
&eeprom_buff[i - first_word],
|
|
0);
|
|
if (ret < 0) {
|
|
kfree(eeprom_buff);
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
memcpy(data, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
|
|
kfree(eeprom_buff);
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_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 ax88179_set_settings(struct net_device *net, struct ethtool_cmd *cmd)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
return mii_ethtool_sset(&dev->mii, cmd);
|
|
}
|
|
|
|
|
|
static int ax88179_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 ethtool_ops ax88179_ethtool_ops = {
|
|
.get_link = ethtool_op_get_link,
|
|
.get_msglevel = usbnet_get_msglevel,
|
|
.set_msglevel = usbnet_set_msglevel,
|
|
.get_wol = ax88179_get_wol,
|
|
.set_wol = ax88179_set_wol,
|
|
.get_eeprom_len = ax88179_get_eeprom_len,
|
|
.get_eeprom = ax88179_get_eeprom,
|
|
.get_settings = ax88179_get_settings,
|
|
.set_settings = ax88179_set_settings,
|
|
.nway_reset = usbnet_nway_reset,
|
|
};
|
|
|
|
static void ax88179_set_multicast(struct net_device *net)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
struct ax88179_data *data = (struct ax88179_data *)dev->data;
|
|
u8 *m_filter = ((u8 *)dev->data) + 12;
|
|
|
|
data->rxctl = (AX_RX_CTL_START | AX_RX_CTL_AB | AX_RX_CTL_IPE);
|
|
|
|
if (net->flags & IFF_PROMISC) {
|
|
data->rxctl |= AX_RX_CTL_PRO;
|
|
} else if (net->flags & IFF_ALLMULTI ||
|
|
netdev_mc_count(net) > AX_MAX_MCAST) {
|
|
data->rxctl |= AX_RX_CTL_AMALL;
|
|
} else if (netdev_mc_empty(net)) {
|
|
/* 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(m_filter, 0, AX_MCAST_FLTSIZE);
|
|
|
|
netdev_for_each_mc_addr(ha, net) {
|
|
crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
|
|
*(m_filter + (crc_bits >> 3)) |= (1 << (crc_bits & 7));
|
|
}
|
|
|
|
ax88179_write_cmd_async(dev, AX_ACCESS_MAC, AX_MULFLTARY,
|
|
AX_MCAST_FLTSIZE, AX_MCAST_FLTSIZE,
|
|
m_filter);
|
|
|
|
data->rxctl |= AX_RX_CTL_AM;
|
|
}
|
|
|
|
ax88179_write_cmd_async(dev, AX_ACCESS_MAC, AX_RX_CTL,
|
|
2, 2, &data->rxctl);
|
|
}
|
|
|
|
static int
|
|
ax88179_set_features(struct net_device *net, netdev_features_t features)
|
|
{
|
|
u8 tmp;
|
|
struct usbnet *dev = netdev_priv(net);
|
|
netdev_features_t changed = net->features ^ features;
|
|
|
|
if (changed & NETIF_F_IP_CSUM) {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
|
|
tmp ^= AX_TXCOE_TCP | AX_TXCOE_UDP;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
|
|
}
|
|
|
|
if (changed & NETIF_F_IPV6_CSUM) {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
|
|
tmp ^= AX_TXCOE_TCPV6 | AX_TXCOE_UDPV6;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
|
|
}
|
|
|
|
if (changed & NETIF_F_RXCSUM) {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, &tmp);
|
|
tmp ^= AX_RXCOE_IP | AX_RXCOE_TCP | AX_RXCOE_UDP |
|
|
AX_RXCOE_TCPV6 | AX_RXCOE_UDPV6;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, &tmp);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_change_mtu(struct net_device *net, int new_mtu)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
u16 tmp16;
|
|
|
|
if (new_mtu <= 0 || new_mtu > 4088)
|
|
return -EINVAL;
|
|
|
|
net->mtu = new_mtu;
|
|
dev->hard_mtu = net->mtu + net->hard_header_len;
|
|
|
|
if (net->mtu > 1500) {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
tmp16 |= AX_MEDIUM_JUMBO_EN;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
} else {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
tmp16 &= ~AX_MEDIUM_JUMBO_EN;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_set_mac_addr(struct net_device *net, void *p)
|
|
{
|
|
struct usbnet *dev = netdev_priv(net);
|
|
struct sockaddr *addr = p;
|
|
|
|
if (netif_running(net))
|
|
return -EBUSY;
|
|
if (!is_valid_ether_addr(addr->sa_data))
|
|
return -EADDRNOTAVAIL;
|
|
|
|
memcpy(net->dev_addr, addr->sa_data, ETH_ALEN);
|
|
|
|
/* Set the MAC address */
|
|
return ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_NODE_ID, ETH_ALEN,
|
|
ETH_ALEN, net->dev_addr);
|
|
}
|
|
|
|
static const struct net_device_ops ax88179_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 = ax88179_change_mtu,
|
|
.ndo_set_mac_address = ax88179_set_mac_addr,
|
|
.ndo_validate_addr = eth_validate_addr,
|
|
.ndo_do_ioctl = ax88179_ioctl,
|
|
.ndo_set_rx_mode = ax88179_set_multicast,
|
|
.ndo_set_features = ax88179_set_features,
|
|
};
|
|
|
|
static int ax88179_check_eeprom(struct usbnet *dev)
|
|
{
|
|
u8 i, buf, eeprom[20];
|
|
u16 csum, delay = HZ / 10;
|
|
unsigned long jtimeout;
|
|
|
|
/* Read EEPROM content */
|
|
for (i = 0; i < 6; i++) {
|
|
buf = i;
|
|
if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_ADDR,
|
|
1, 1, &buf) < 0)
|
|
return -EINVAL;
|
|
|
|
buf = EEP_RD;
|
|
if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
|
|
1, 1, &buf) < 0)
|
|
return -EINVAL;
|
|
|
|
jtimeout = jiffies + delay;
|
|
do {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
|
|
1, 1, &buf);
|
|
|
|
if (time_after(jiffies, jtimeout))
|
|
return -EINVAL;
|
|
|
|
} while (buf & EEP_BUSY);
|
|
|
|
__ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_DATA_LOW,
|
|
2, 2, &eeprom[i * 2], 0);
|
|
|
|
if ((i == 0) && (eeprom[0] == 0xFF))
|
|
return -EINVAL;
|
|
}
|
|
|
|
csum = eeprom[6] + eeprom[7] + eeprom[8] + eeprom[9];
|
|
csum = (csum >> 8) + (csum & 0xff);
|
|
if ((csum + eeprom[10]) != 0xff)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_check_efuse(struct usbnet *dev, u16 *ledmode)
|
|
{
|
|
u8 i;
|
|
u8 efuse[64];
|
|
u16 csum = 0;
|
|
|
|
if (ax88179_read_cmd(dev, AX_ACCESS_EFUS, 0, 64, 64, efuse) < 0)
|
|
return -EINVAL;
|
|
|
|
if (*efuse == 0xFF)
|
|
return -EINVAL;
|
|
|
|
for (i = 0; i < 64; i++)
|
|
csum = csum + efuse[i];
|
|
|
|
while (csum > 255)
|
|
csum = (csum & 0x00FF) + ((csum >> 8) & 0x00FF);
|
|
|
|
if (csum != 0xFF)
|
|
return -EINVAL;
|
|
|
|
*ledmode = (efuse[51] << 8) | efuse[52];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_convert_old_led(struct usbnet *dev, u16 *ledvalue)
|
|
{
|
|
u16 led;
|
|
|
|
/* Loaded the old eFuse LED Mode */
|
|
if (ax88179_read_cmd(dev, AX_ACCESS_EEPROM, 0x3C, 1, 2, &led) < 0)
|
|
return -EINVAL;
|
|
|
|
led >>= 8;
|
|
switch (led) {
|
|
case 0xFF:
|
|
led = LED0_ACTIVE | LED1_LINK_10 | LED1_LINK_100 |
|
|
LED1_LINK_1000 | LED2_ACTIVE | LED2_LINK_10 |
|
|
LED2_LINK_100 | LED2_LINK_1000 | LED_VALID;
|
|
break;
|
|
case 0xFE:
|
|
led = LED0_ACTIVE | LED1_LINK_1000 | LED2_LINK_100 | LED_VALID;
|
|
break;
|
|
case 0xFD:
|
|
led = LED0_ACTIVE | LED1_LINK_1000 | LED2_LINK_100 |
|
|
LED2_LINK_10 | LED_VALID;
|
|
break;
|
|
case 0xFC:
|
|
led = LED0_ACTIVE | LED1_ACTIVE | LED1_LINK_1000 | LED2_ACTIVE |
|
|
LED2_LINK_100 | LED2_LINK_10 | LED_VALID;
|
|
break;
|
|
default:
|
|
led = LED0_ACTIVE | LED1_LINK_10 | LED1_LINK_100 |
|
|
LED1_LINK_1000 | LED2_ACTIVE | LED2_LINK_10 |
|
|
LED2_LINK_100 | LED2_LINK_1000 | LED_VALID;
|
|
break;
|
|
}
|
|
|
|
*ledvalue = led;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_led_setting(struct usbnet *dev)
|
|
{
|
|
u8 ledfd, value = 0;
|
|
u16 tmp, ledact, ledlink, ledvalue = 0, delay = HZ / 10;
|
|
unsigned long jtimeout;
|
|
|
|
/* Check AX88179 version. UA1 or UA2*/
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, GENERAL_STATUS, 1, 1, &value);
|
|
|
|
if (!(value & AX_SECLD)) { /* UA1 */
|
|
value = AX_GPIO_CTRL_GPIO3EN | AX_GPIO_CTRL_GPIO2EN |
|
|
AX_GPIO_CTRL_GPIO1EN;
|
|
if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_GPIO_CTRL,
|
|
1, 1, &value) < 0)
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Check EEPROM */
|
|
if (!ax88179_check_eeprom(dev)) {
|
|
value = 0x42;
|
|
if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_ADDR,
|
|
1, 1, &value) < 0)
|
|
return -EINVAL;
|
|
|
|
value = EEP_RD;
|
|
if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
|
|
1, 1, &value) < 0)
|
|
return -EINVAL;
|
|
|
|
jtimeout = jiffies + delay;
|
|
do {
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
|
|
1, 1, &value);
|
|
|
|
if (time_after(jiffies, jtimeout))
|
|
return -EINVAL;
|
|
|
|
} while (value & EEP_BUSY);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_DATA_HIGH,
|
|
1, 1, &value);
|
|
ledvalue = (value << 8);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_DATA_LOW,
|
|
1, 1, &value);
|
|
ledvalue |= value;
|
|
|
|
/* load internal ROM for defaule setting */
|
|
if ((ledvalue == 0xFFFF) || ((ledvalue & LED_VALID) == 0))
|
|
ax88179_convert_old_led(dev, &ledvalue);
|
|
|
|
} else if (!ax88179_check_efuse(dev, &ledvalue)) {
|
|
if ((ledvalue == 0xFFFF) || ((ledvalue & LED_VALID) == 0))
|
|
ax88179_convert_old_led(dev, &ledvalue);
|
|
} else {
|
|
ax88179_convert_old_led(dev, &ledvalue);
|
|
}
|
|
|
|
tmp = GMII_PHY_PGSEL_EXT;
|
|
ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_PHY_PAGE_SELECT, 2, &tmp);
|
|
|
|
tmp = 0x2c;
|
|
ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_PHYPAGE, 2, &tmp);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_LED_ACT, 2, &ledact);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_LED_LINK, 2, &ledlink);
|
|
|
|
ledact &= GMII_LED_ACTIVE_MASK;
|
|
ledlink &= GMII_LED_LINK_MASK;
|
|
|
|
if (ledvalue & LED0_ACTIVE)
|
|
ledact |= GMII_LED0_ACTIVE;
|
|
|
|
if (ledvalue & LED1_ACTIVE)
|
|
ledact |= GMII_LED1_ACTIVE;
|
|
|
|
if (ledvalue & LED2_ACTIVE)
|
|
ledact |= GMII_LED2_ACTIVE;
|
|
|
|
if (ledvalue & LED0_LINK_10)
|
|
ledlink |= GMII_LED0_LINK_10;
|
|
|
|
if (ledvalue & LED1_LINK_10)
|
|
ledlink |= GMII_LED1_LINK_10;
|
|
|
|
if (ledvalue & LED2_LINK_10)
|
|
ledlink |= GMII_LED2_LINK_10;
|
|
|
|
if (ledvalue & LED0_LINK_100)
|
|
ledlink |= GMII_LED0_LINK_100;
|
|
|
|
if (ledvalue & LED1_LINK_100)
|
|
ledlink |= GMII_LED1_LINK_100;
|
|
|
|
if (ledvalue & LED2_LINK_100)
|
|
ledlink |= GMII_LED2_LINK_100;
|
|
|
|
if (ledvalue & LED0_LINK_1000)
|
|
ledlink |= GMII_LED0_LINK_1000;
|
|
|
|
if (ledvalue & LED1_LINK_1000)
|
|
ledlink |= GMII_LED1_LINK_1000;
|
|
|
|
if (ledvalue & LED2_LINK_1000)
|
|
ledlink |= GMII_LED2_LINK_1000;
|
|
|
|
tmp = ledact;
|
|
ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_LED_ACT, 2, &tmp);
|
|
|
|
tmp = ledlink;
|
|
ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_LED_LINK, 2, &tmp);
|
|
|
|
tmp = GMII_PHY_PGSEL_PAGE0;
|
|
ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_PHY_PAGE_SELECT, 2, &tmp);
|
|
|
|
/* LED full duplex setting */
|
|
ledfd = 0;
|
|
if (ledvalue & LED0_FD)
|
|
ledfd |= 0x01;
|
|
else if ((ledvalue & LED0_USB3_MASK) == 0)
|
|
ledfd |= 0x02;
|
|
|
|
if (ledvalue & LED1_FD)
|
|
ledfd |= 0x04;
|
|
else if ((ledvalue & LED1_USB3_MASK) == 0)
|
|
ledfd |= 0x08;
|
|
|
|
if (ledvalue & LED2_FD)
|
|
ledfd |= 0x10;
|
|
else if ((ledvalue & LED2_USB3_MASK) == 0)
|
|
ledfd |= 0x20;
|
|
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_LEDCTRL, 1, 1, &ledfd);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_bind(struct usbnet *dev, struct usb_interface *intf)
|
|
{
|
|
u8 buf[5];
|
|
u16 *tmp16;
|
|
u8 *tmp;
|
|
struct ax88179_data *ax179_data = (struct ax88179_data *)dev->data;
|
|
|
|
usbnet_get_endpoints(dev, intf);
|
|
|
|
tmp16 = (u16 *)buf;
|
|
tmp = (u8 *)buf;
|
|
|
|
memset(ax179_data, 0, sizeof(*ax179_data));
|
|
|
|
/* Power up ethernet PHY */
|
|
*tmp16 = 0;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
|
|
*tmp16 = AX_PHYPWR_RSTCTL_IPRL;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
|
|
msleep(200);
|
|
|
|
*tmp = AX_CLK_SELECT_ACS | AX_CLK_SELECT_BCS;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, tmp);
|
|
msleep(100);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_NODE_ID, ETH_ALEN,
|
|
ETH_ALEN, dev->net->dev_addr);
|
|
memcpy(dev->net->perm_addr, dev->net->dev_addr, ETH_ALEN);
|
|
|
|
/* RX bulk configuration */
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[0], 5);
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_BULKIN_QCTRL, 5, 5, tmp);
|
|
|
|
dev->rx_urb_size = 1024 * 20;
|
|
|
|
*tmp = 0x34;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_LOW, 1, 1, tmp);
|
|
|
|
*tmp = 0x52;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_HIGH,
|
|
1, 1, tmp);
|
|
|
|
dev->net->netdev_ops = &ax88179_netdev_ops;
|
|
dev->net->ethtool_ops = &ax88179_ethtool_ops;
|
|
dev->net->needed_headroom = 8;
|
|
|
|
/* Initialize MII structure */
|
|
dev->mii.dev = dev->net;
|
|
dev->mii.mdio_read = ax88179_mdio_read;
|
|
dev->mii.mdio_write = ax88179_mdio_write;
|
|
dev->mii.phy_id_mask = 0xff;
|
|
dev->mii.reg_num_mask = 0xff;
|
|
dev->mii.phy_id = 0x03;
|
|
dev->mii.supports_gmii = 1;
|
|
|
|
dev->net->features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
|
|
NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_TSO;
|
|
|
|
dev->net->hw_features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
|
|
NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_TSO;
|
|
|
|
/* Enable checksum offload */
|
|
*tmp = AX_RXCOE_IP | AX_RXCOE_TCP | AX_RXCOE_UDP |
|
|
AX_RXCOE_TCPV6 | AX_RXCOE_UDPV6;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, tmp);
|
|
|
|
*tmp = AX_TXCOE_IP | AX_TXCOE_TCP | AX_TXCOE_UDP |
|
|
AX_TXCOE_TCPV6 | AX_TXCOE_UDPV6;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, tmp);
|
|
|
|
/* Configure RX control register => start operation */
|
|
*tmp16 = AX_RX_CTL_DROPCRCERR | AX_RX_CTL_IPE | AX_RX_CTL_START |
|
|
AX_RX_CTL_AP | AX_RX_CTL_AMALL | AX_RX_CTL_AB;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, tmp16);
|
|
|
|
*tmp = AX_MONITOR_MODE_PMETYPE | AX_MONITOR_MODE_PMEPOL |
|
|
AX_MONITOR_MODE_RWMP;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD, 1, 1, tmp);
|
|
|
|
/* Configure default medium type => giga */
|
|
*tmp16 = AX_MEDIUM_RECEIVE_EN | AX_MEDIUM_TXFLOW_CTRLEN |
|
|
AX_MEDIUM_RXFLOW_CTRLEN | AX_MEDIUM_ALWAYS_ONE |
|
|
AX_MEDIUM_FULL_DUPLEX | AX_MEDIUM_GIGAMODE;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, tmp16);
|
|
|
|
ax88179_led_setting(dev);
|
|
|
|
/* Restart autoneg */
|
|
mii_nway_restart(&dev->mii);
|
|
|
|
usbnet_link_change(dev, 0, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ax88179_unbind(struct usbnet *dev, struct usb_interface *intf)
|
|
{
|
|
u16 tmp16;
|
|
|
|
/* Configure RX control register => stop operation */
|
|
tmp16 = AX_RX_CTL_STOP;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &tmp16);
|
|
|
|
tmp16 = 0;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp16);
|
|
|
|
/* Power down ethernet PHY */
|
|
tmp16 = 0;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, &tmp16);
|
|
}
|
|
|
|
static void
|
|
ax88179_rx_checksum(struct sk_buff *skb, u32 *pkt_hdr)
|
|
{
|
|
skb->ip_summed = CHECKSUM_NONE;
|
|
|
|
/* checksum error bit is set */
|
|
if ((*pkt_hdr & AX_RXHDR_L3CSUM_ERR) ||
|
|
(*pkt_hdr & AX_RXHDR_L4CSUM_ERR))
|
|
return;
|
|
|
|
/* It must be a TCP or UDP packet with a valid checksum */
|
|
if (((*pkt_hdr & AX_RXHDR_L4_TYPE_MASK) == AX_RXHDR_L4_TYPE_TCP) ||
|
|
((*pkt_hdr & AX_RXHDR_L4_TYPE_MASK) == AX_RXHDR_L4_TYPE_UDP))
|
|
skb->ip_summed = CHECKSUM_UNNECESSARY;
|
|
}
|
|
|
|
static int ax88179_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
|
|
{
|
|
struct sk_buff *ax_skb;
|
|
int pkt_cnt;
|
|
u32 rx_hdr;
|
|
u16 hdr_off;
|
|
u32 *pkt_hdr;
|
|
|
|
skb_trim(skb, skb->len - 4);
|
|
memcpy(&rx_hdr, skb_tail_pointer(skb), 4);
|
|
le32_to_cpus(&rx_hdr);
|
|
|
|
pkt_cnt = (u16)rx_hdr;
|
|
hdr_off = (u16)(rx_hdr >> 16);
|
|
pkt_hdr = (u32 *)(skb->data + hdr_off);
|
|
|
|
while (pkt_cnt--) {
|
|
u16 pkt_len;
|
|
|
|
le32_to_cpus(pkt_hdr);
|
|
pkt_len = (*pkt_hdr >> 16) & 0x1fff;
|
|
|
|
/* Check CRC or runt packet */
|
|
if ((*pkt_hdr & AX_RXHDR_CRC_ERR) ||
|
|
(*pkt_hdr & AX_RXHDR_DROP_ERR)) {
|
|
skb_pull(skb, (pkt_len + 7) & 0xFFF8);
|
|
pkt_hdr++;
|
|
continue;
|
|
}
|
|
|
|
if (pkt_cnt == 0) {
|
|
/* Skip IP alignment psudo header */
|
|
skb_pull(skb, 2);
|
|
skb->len = pkt_len;
|
|
skb_set_tail_pointer(skb, pkt_len);
|
|
skb->truesize = pkt_len + sizeof(struct sk_buff);
|
|
ax88179_rx_checksum(skb, pkt_hdr);
|
|
return 1;
|
|
}
|
|
|
|
ax_skb = skb_clone(skb, GFP_ATOMIC);
|
|
if (ax_skb) {
|
|
ax_skb->len = pkt_len;
|
|
ax_skb->data = skb->data + 2;
|
|
skb_set_tail_pointer(ax_skb, pkt_len);
|
|
ax_skb->truesize = pkt_len + sizeof(struct sk_buff);
|
|
ax88179_rx_checksum(ax_skb, pkt_hdr);
|
|
usbnet_skb_return(dev, ax_skb);
|
|
} else {
|
|
return 0;
|
|
}
|
|
|
|
skb_pull(skb, (pkt_len + 7) & 0xFFF8);
|
|
pkt_hdr++;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
static struct sk_buff *
|
|
ax88179_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags)
|
|
{
|
|
u32 tx_hdr1, tx_hdr2;
|
|
int frame_size = dev->maxpacket;
|
|
int mss = skb_shinfo(skb)->gso_size;
|
|
int headroom;
|
|
int tailroom;
|
|
|
|
tx_hdr1 = skb->len;
|
|
tx_hdr2 = mss;
|
|
if (((skb->len + 8) % frame_size) == 0)
|
|
tx_hdr2 |= 0x80008000; /* Enable padding */
|
|
|
|
skb_linearize(skb);
|
|
headroom = skb_headroom(skb);
|
|
tailroom = skb_tailroom(skb);
|
|
|
|
if (!skb_header_cloned(skb) &&
|
|
!skb_cloned(skb) &&
|
|
(headroom + tailroom) >= 8) {
|
|
if (headroom < 8) {
|
|
skb->data = memmove(skb->head + 8, skb->data, skb->len);
|
|
skb_set_tail_pointer(skb, skb->len);
|
|
}
|
|
} else {
|
|
struct sk_buff *skb2;
|
|
|
|
skb2 = skb_copy_expand(skb, 8, 0, flags);
|
|
dev_kfree_skb_any(skb);
|
|
skb = skb2;
|
|
if (!skb)
|
|
return NULL;
|
|
}
|
|
|
|
skb_push(skb, 4);
|
|
cpu_to_le32s(&tx_hdr2);
|
|
skb_copy_to_linear_data(skb, &tx_hdr2, 4);
|
|
|
|
skb_push(skb, 4);
|
|
cpu_to_le32s(&tx_hdr1);
|
|
skb_copy_to_linear_data(skb, &tx_hdr1, 4);
|
|
|
|
return skb;
|
|
}
|
|
|
|
static int ax88179_link_reset(struct usbnet *dev)
|
|
{
|
|
struct ax88179_data *ax179_data = (struct ax88179_data *)dev->data;
|
|
u8 tmp[5], link_sts;
|
|
u16 mode, tmp16, delay = HZ / 10;
|
|
u32 tmp32 = 0x40000000;
|
|
unsigned long jtimeout;
|
|
|
|
jtimeout = jiffies + delay;
|
|
while (tmp32 & 0x40000000) {
|
|
mode = 0;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &mode);
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2,
|
|
&ax179_data->rxctl);
|
|
|
|
/*link up, check the usb device control TX FIFO full or empty*/
|
|
ax88179_read_cmd(dev, 0x81, 0x8c, 0, 4, &tmp32);
|
|
|
|
if (time_after(jiffies, jtimeout))
|
|
return 0;
|
|
}
|
|
|
|
mode = AX_MEDIUM_RECEIVE_EN | AX_MEDIUM_TXFLOW_CTRLEN |
|
|
AX_MEDIUM_RXFLOW_CTRLEN | AX_MEDIUM_ALWAYS_ONE;
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, PHYSICAL_LINK_STATUS,
|
|
1, 1, &link_sts);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
|
|
GMII_PHY_PHYSR, 2, &tmp16);
|
|
|
|
if (!(tmp16 & GMII_PHY_PHYSR_LINK)) {
|
|
return 0;
|
|
} else if (GMII_PHY_PHYSR_GIGA == (tmp16 & GMII_PHY_PHYSR_SMASK)) {
|
|
mode |= AX_MEDIUM_GIGAMODE | AX_MEDIUM_EN_125MHZ;
|
|
if (dev->net->mtu > 1500)
|
|
mode |= AX_MEDIUM_JUMBO_EN;
|
|
|
|
if (link_sts & AX_USB_SS)
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[0], 5);
|
|
else if (link_sts & AX_USB_HS)
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[1], 5);
|
|
else
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[3], 5);
|
|
} else if (GMII_PHY_PHYSR_100 == (tmp16 & GMII_PHY_PHYSR_SMASK)) {
|
|
mode |= AX_MEDIUM_PS;
|
|
|
|
if (link_sts & (AX_USB_SS | AX_USB_HS))
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[2], 5);
|
|
else
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[3], 5);
|
|
} else {
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[3], 5);
|
|
}
|
|
|
|
/* RX bulk configuration */
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_BULKIN_QCTRL, 5, 5, tmp);
|
|
|
|
dev->rx_urb_size = (1024 * (tmp[3] + 2));
|
|
|
|
if (tmp16 & GMII_PHY_PHYSR_FULL)
|
|
mode |= AX_MEDIUM_FULL_DUPLEX;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &mode);
|
|
|
|
netif_carrier_on(dev->net);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_reset(struct usbnet *dev)
|
|
{
|
|
u8 buf[5];
|
|
u16 *tmp16;
|
|
u8 *tmp;
|
|
|
|
tmp16 = (u16 *)buf;
|
|
tmp = (u8 *)buf;
|
|
|
|
/* Power up ethernet PHY */
|
|
*tmp16 = 0;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
|
|
|
|
*tmp16 = AX_PHYPWR_RSTCTL_IPRL;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
|
|
msleep(200);
|
|
|
|
*tmp = AX_CLK_SELECT_ACS | AX_CLK_SELECT_BCS;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, tmp);
|
|
msleep(100);
|
|
|
|
/* Ethernet PHY Auto Detach*/
|
|
ax88179_auto_detach(dev, 0);
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_NODE_ID, ETH_ALEN, ETH_ALEN,
|
|
dev->net->dev_addr);
|
|
memcpy(dev->net->perm_addr, dev->net->dev_addr, ETH_ALEN);
|
|
|
|
/* RX bulk configuration */
|
|
memcpy(tmp, &AX88179_BULKIN_SIZE[0], 5);
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_BULKIN_QCTRL, 5, 5, tmp);
|
|
|
|
dev->rx_urb_size = 1024 * 20;
|
|
|
|
*tmp = 0x34;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_LOW, 1, 1, tmp);
|
|
|
|
*tmp = 0x52;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_HIGH,
|
|
1, 1, tmp);
|
|
|
|
dev->net->features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
|
|
NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_TSO;
|
|
|
|
dev->net->hw_features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
|
|
NETIF_F_RXCSUM | NETIF_F_SG | NETIF_F_TSO;
|
|
|
|
/* Enable checksum offload */
|
|
*tmp = AX_RXCOE_IP | AX_RXCOE_TCP | AX_RXCOE_UDP |
|
|
AX_RXCOE_TCPV6 | AX_RXCOE_UDPV6;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, tmp);
|
|
|
|
*tmp = AX_TXCOE_IP | AX_TXCOE_TCP | AX_TXCOE_UDP |
|
|
AX_TXCOE_TCPV6 | AX_TXCOE_UDPV6;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, tmp);
|
|
|
|
/* Configure RX control register => start operation */
|
|
*tmp16 = AX_RX_CTL_DROPCRCERR | AX_RX_CTL_IPE | AX_RX_CTL_START |
|
|
AX_RX_CTL_AP | AX_RX_CTL_AMALL | AX_RX_CTL_AB;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, tmp16);
|
|
|
|
*tmp = AX_MONITOR_MODE_PMETYPE | AX_MONITOR_MODE_PMEPOL |
|
|
AX_MONITOR_MODE_RWMP;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD, 1, 1, tmp);
|
|
|
|
/* Configure default medium type => giga */
|
|
*tmp16 = AX_MEDIUM_RECEIVE_EN | AX_MEDIUM_TXFLOW_CTRLEN |
|
|
AX_MEDIUM_RXFLOW_CTRLEN | AX_MEDIUM_ALWAYS_ONE |
|
|
AX_MEDIUM_FULL_DUPLEX | AX_MEDIUM_GIGAMODE;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, tmp16);
|
|
|
|
ax88179_led_setting(dev);
|
|
|
|
/* Restart autoneg */
|
|
mii_nway_restart(&dev->mii);
|
|
|
|
usbnet_link_change(dev, 0, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ax88179_stop(struct usbnet *dev)
|
|
{
|
|
u16 tmp16;
|
|
|
|
ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
tmp16 &= ~AX_MEDIUM_RECEIVE_EN;
|
|
ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
|
|
2, 2, &tmp16);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct driver_info ax88179_info = {
|
|
.description = "ASIX AX88179 USB 3.0 Gigibit Ethernet",
|
|
.bind = ax88179_bind,
|
|
.unbind = ax88179_unbind,
|
|
.status = ax88179_status,
|
|
.link_reset = ax88179_link_reset,
|
|
.reset = ax88179_reset,
|
|
.stop = ax88179_stop,
|
|
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
|
|
.rx_fixup = ax88179_rx_fixup,
|
|
.tx_fixup = ax88179_tx_fixup,
|
|
};
|
|
|
|
static const struct driver_info ax88178a_info = {
|
|
.description = "ASIX AX88178A USB 2.0 Gigibit Ethernet",
|
|
.bind = ax88179_bind,
|
|
.unbind = ax88179_unbind,
|
|
.status = ax88179_status,
|
|
.link_reset = ax88179_link_reset,
|
|
.reset = ax88179_reset,
|
|
.stop = ax88179_stop,
|
|
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
|
|
.rx_fixup = ax88179_rx_fixup,
|
|
.tx_fixup = ax88179_tx_fixup,
|
|
};
|
|
|
|
static const struct driver_info sitecom_info = {
|
|
.description = "Sitecom USB 3.0 to Gigabit Adapter",
|
|
.bind = ax88179_bind,
|
|
.unbind = ax88179_unbind,
|
|
.status = ax88179_status,
|
|
.link_reset = ax88179_link_reset,
|
|
.reset = ax88179_reset,
|
|
.stop = ax88179_stop,
|
|
.flags = FLAG_ETHER | FLAG_FRAMING_AX,
|
|
.rx_fixup = ax88179_rx_fixup,
|
|
.tx_fixup = ax88179_tx_fixup,
|
|
};
|
|
|
|
static const struct usb_device_id products[] = {
|
|
{
|
|
/* ASIX AX88179 10/100/1000 */
|
|
USB_DEVICE(0x0b95, 0x1790),
|
|
.driver_info = (unsigned long)&ax88179_info,
|
|
}, {
|
|
/* ASIX AX88178A 10/100/1000 */
|
|
USB_DEVICE(0x0b95, 0x178a),
|
|
.driver_info = (unsigned long)&ax88178a_info,
|
|
}, {
|
|
/* Sitecom USB 3.0 to Gigabit Adapter */
|
|
USB_DEVICE(0x0df6, 0x0072),
|
|
.driver_info = (unsigned long) &sitecom_info,
|
|
},
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(usb, products);
|
|
|
|
static struct usb_driver ax88179_178a_driver = {
|
|
.name = "ax88179_178a",
|
|
.id_table = products,
|
|
.probe = usbnet_probe,
|
|
.suspend = ax88179_suspend,
|
|
.resume = ax88179_resume,
|
|
.disconnect = usbnet_disconnect,
|
|
.supports_autosuspend = 1,
|
|
.disable_hub_initiated_lpm = 1,
|
|
};
|
|
|
|
module_usb_driver(ax88179_178a_driver);
|
|
|
|
MODULE_DESCRIPTION("ASIX AX88179/178A based USB 3.0/2.0 Gigabit Ethernet Devices");
|
|
MODULE_LICENSE("GPL");
|