| /* | |
| * ASIX AX8817X based USB 2.0 Ethernet Devices | |
| * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com> | |
| * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net> | |
| * Copyright (C) 2006 James Painter <jamie.painter@iname.com> | |
| * 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 | |
| */ | |
| // #define DEBUG // error path messages, extra info | |
| // #define VERBOSE // more; success messages | |
| #include <linux/module.h> | |
| #include <linux/kmod.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 <linux/slab.h> | |
| #define DRIVER_VERSION "14-Jun-2006" | |
| static const char driver_name [] = "asix"; | |
| /* ASIX AX8817X based USB 2.0 Ethernet Devices */ | |
| #define AX_CMD_SET_SW_MII 0x06 | |
| #define AX_CMD_READ_MII_REG 0x07 | |
| #define AX_CMD_WRITE_MII_REG 0x08 | |
| #define AX_CMD_SET_HW_MII 0x0a | |
| #define AX_CMD_READ_EEPROM 0x0b | |
| #define AX_CMD_WRITE_EEPROM 0x0c | |
| #define AX_CMD_WRITE_ENABLE 0x0d | |
| #define AX_CMD_WRITE_DISABLE 0x0e | |
| #define AX_CMD_READ_RX_CTL 0x0f | |
| #define AX_CMD_WRITE_RX_CTL 0x10 | |
| #define AX_CMD_READ_IPG012 0x11 | |
| #define AX_CMD_WRITE_IPG0 0x12 | |
| #define AX_CMD_WRITE_IPG1 0x13 | |
| #define AX_CMD_READ_NODE_ID 0x13 | |
| #define AX_CMD_WRITE_NODE_ID 0x14 | |
| #define AX_CMD_WRITE_IPG2 0x14 | |
| #define AX_CMD_WRITE_MULTI_FILTER 0x16 | |
| #define AX88172_CMD_READ_NODE_ID 0x17 | |
| #define AX_CMD_READ_PHY_ID 0x19 | |
| #define AX_CMD_READ_MEDIUM_STATUS 0x1a | |
| #define AX_CMD_WRITE_MEDIUM_MODE 0x1b | |
| #define AX_CMD_READ_MONITOR_MODE 0x1c | |
| #define AX_CMD_WRITE_MONITOR_MODE 0x1d | |
| #define AX_CMD_READ_GPIOS 0x1e | |
| #define AX_CMD_WRITE_GPIOS 0x1f | |
| #define AX_CMD_SW_RESET 0x20 | |
| #define AX_CMD_SW_PHY_STATUS 0x21 | |
| #define AX_CMD_SW_PHY_SELECT 0x22 | |
| #define AX_MONITOR_MODE 0x01 | |
| #define AX_MONITOR_LINK 0x02 | |
| #define AX_MONITOR_MAGIC 0x04 | |
| #define AX_MONITOR_HSFS 0x10 | |
| /* AX88172 Medium Status Register values */ | |
| #define AX88172_MEDIUM_FD 0x02 | |
| #define AX88172_MEDIUM_TX 0x04 | |
| #define AX88172_MEDIUM_FC 0x10 | |
| #define AX88172_MEDIUM_DEFAULT \ | |
| ( AX88172_MEDIUM_FD | AX88172_MEDIUM_TX | AX88172_MEDIUM_FC ) | |
| #define AX_MCAST_FILTER_SIZE 8 | |
| #define AX_MAX_MCAST 64 | |
| #define AX_SWRESET_CLEAR 0x00 | |
| #define AX_SWRESET_RR 0x01 | |
| #define AX_SWRESET_RT 0x02 | |
| #define AX_SWRESET_PRTE 0x04 | |
| #define AX_SWRESET_PRL 0x08 | |
| #define AX_SWRESET_BZ 0x10 | |
| #define AX_SWRESET_IPRL 0x20 | |
| #define AX_SWRESET_IPPD 0x40 | |
| #define AX88772_IPG0_DEFAULT 0x15 | |
| #define AX88772_IPG1_DEFAULT 0x0c | |
| #define AX88772_IPG2_DEFAULT 0x12 | |
| /* AX88772 & AX88178 Medium Mode Register */ | |
| #define AX_MEDIUM_PF 0x0080 | |
| #define AX_MEDIUM_JFE 0x0040 | |
| #define AX_MEDIUM_TFC 0x0020 | |
| #define AX_MEDIUM_RFC 0x0010 | |
| #define AX_MEDIUM_ENCK 0x0008 | |
| #define AX_MEDIUM_AC 0x0004 | |
| #define AX_MEDIUM_FD 0x0002 | |
| #define AX_MEDIUM_GM 0x0001 | |
| #define AX_MEDIUM_SM 0x1000 | |
| #define AX_MEDIUM_SBP 0x0800 | |
| #define AX_MEDIUM_PS 0x0200 | |
| #define AX_MEDIUM_RE 0x0100 | |
| #define AX88178_MEDIUM_DEFAULT \ | |
| (AX_MEDIUM_PS | AX_MEDIUM_FD | AX_MEDIUM_AC | \ | |
| AX_MEDIUM_RFC | AX_MEDIUM_TFC | AX_MEDIUM_JFE | \ | |
| AX_MEDIUM_RE ) | |
| #define AX88772_MEDIUM_DEFAULT \ | |
| (AX_MEDIUM_FD | AX_MEDIUM_RFC | \ | |
| AX_MEDIUM_TFC | AX_MEDIUM_PS | \ | |
| AX_MEDIUM_AC | AX_MEDIUM_RE ) | |
| /* AX88772 & AX88178 RX_CTL values */ | |
| #define AX_RX_CTL_SO 0x0080 | |
| #define AX_RX_CTL_AP 0x0020 | |
| #define AX_RX_CTL_AM 0x0010 | |
| #define AX_RX_CTL_AB 0x0008 | |
| #define AX_RX_CTL_SEP 0x0004 | |
| #define AX_RX_CTL_AMALL 0x0002 | |
| #define AX_RX_CTL_PRO 0x0001 | |
| #define AX_RX_CTL_MFB_2048 0x0000 | |
| #define AX_RX_CTL_MFB_4096 0x0100 | |
| #define AX_RX_CTL_MFB_8192 0x0200 | |
| #define AX_RX_CTL_MFB_16384 0x0300 | |
| #define AX_DEFAULT_RX_CTL \ | |
| (AX_RX_CTL_SO | AX_RX_CTL_AB ) | |
| /* GPIO 0 .. 2 toggles */ | |
| #define AX_GPIO_GPO0EN 0x01 /* GPIO0 Output enable */ | |
| #define AX_GPIO_GPO_0 0x02 /* GPIO0 Output value */ | |
| #define AX_GPIO_GPO1EN 0x04 /* GPIO1 Output enable */ | |
| #define AX_GPIO_GPO_1 0x08 /* GPIO1 Output value */ | |
| #define AX_GPIO_GPO2EN 0x10 /* GPIO2 Output enable */ | |
| #define AX_GPIO_GPO_2 0x20 /* GPIO2 Output value */ | |
| #define AX_GPIO_RESERVED 0x40 /* Reserved */ | |
| #define AX_GPIO_RSE 0x80 /* Reload serial EEPROM */ | |
| #define AX_EEPROM_MAGIC 0xdeadbeef | |
| #define AX88172_EEPROM_LEN 0x40 | |
| #define AX88772_EEPROM_LEN 0xff | |
| #define PHY_MODE_MARVELL 0x0000 | |
| #define MII_MARVELL_LED_CTRL 0x0018 | |
| #define MII_MARVELL_STATUS 0x001b | |
| #define MII_MARVELL_CTRL 0x0014 | |
| #define MARVELL_LED_MANUAL 0x0019 | |
| #define MARVELL_STATUS_HWCFG 0x0004 | |
| #define MARVELL_CTRL_TXDELAY 0x0002 | |
| #define MARVELL_CTRL_RXDELAY 0x0080 | |
| /* This structure cannot exceed sizeof(unsigned long [5]) AKA 20 bytes */ | |
| struct asix_data { | |
| u8 multi_filter[AX_MCAST_FILTER_SIZE]; | |
| u8 mac_addr[ETH_ALEN]; | |
| u8 phymode; | |
| u8 ledmode; | |
| u8 eeprom_len; | |
| }; | |
| struct ax88172_int_data { | |
| __le16 res1; | |
| u8 link; | |
| __le16 res2; | |
| u8 status; | |
| __le16 res3; | |
| } __packed; | |
| static int asix_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index, | |
| u16 size, void *data) | |
| { | |
| void *buf; | |
| int err = -ENOMEM; | |
| netdev_dbg(dev->net, "asix_read_cmd() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n", | |
| cmd, value, index, size); | |
| buf = kmalloc(size, GFP_KERNEL); | |
| if (!buf) | |
| goto out; | |
| err = usb_control_msg( | |
| dev->udev, | |
| usb_rcvctrlpipe(dev->udev, 0), | |
| cmd, | |
| USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | |
| value, | |
| index, | |
| buf, | |
| size, | |
| USB_CTRL_GET_TIMEOUT); | |
| if (err == size) | |
| memcpy(data, buf, size); | |
| else if (err >= 0) | |
| err = -EINVAL; | |
| kfree(buf); | |
| out: | |
| return err; | |
| } | |
| static int asix_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index, | |
| u16 size, void *data) | |
| { | |
| void *buf = NULL; | |
| int err = -ENOMEM; | |
| netdev_dbg(dev->net, "asix_write_cmd() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n", | |
| cmd, value, index, size); | |
| if (data) { | |
| buf = kmemdup(data, size, GFP_KERNEL); | |
| if (!buf) | |
| goto out; | |
| } | |
| err = usb_control_msg( | |
| dev->udev, | |
| usb_sndctrlpipe(dev->udev, 0), | |
| cmd, | |
| USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | |
| value, | |
| index, | |
| buf, | |
| size, | |
| USB_CTRL_SET_TIMEOUT); | |
| kfree(buf); | |
| out: | |
| return err; | |
| } | |
| static void asix_async_cmd_callback(struct urb *urb) | |
| { | |
| struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context; | |
| int status = urb->status; | |
| if (status < 0) | |
| printk(KERN_DEBUG "asix_async_cmd_callback() failed with %d", | |
| status); | |
| kfree(req); | |
| usb_free_urb(urb); | |
| } | |
| static void | |
| asix_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; | |
| netdev_dbg(dev->net, "asix_write_cmd_async() cmd=0x%02x value=0x%04x index=0x%04x size=%d\n", | |
| cmd, value, index, size); | |
| if ((urb = usb_alloc_urb(0, GFP_ATOMIC)) == NULL) { | |
| netdev_err(dev->net, "Error allocating URB in write_cmd_async!\n"); | |
| return; | |
| } | |
| if ((req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC)) == NULL) { | |
| netdev_err(dev->net, "Failed to allocate memory for control request\n"); | |
| 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, | |
| asix_async_cmd_callback, req); | |
| if((status = usb_submit_urb(urb, GFP_ATOMIC)) < 0) { | |
| netdev_err(dev->net, "Error submitting the control message: status=%d\n", | |
| status); | |
| kfree(req); | |
| usb_free_urb(urb); | |
| } | |
| } | |
| static int asix_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 ((header & 0x07ff) != ((~header >> 16) & 0x07ff)) | |
| netdev_err(dev->net, "asix_rx_fixup() Bad Header Length\n"); | |
| /* get the packet length */ | |
| size = (u16) (header & 0x000007ff); | |
| if ((skb->len) - ((size + 1) & 0xfffe) == 0) { | |
| u8 alignment = (unsigned long)skb->data & 0x3; | |
| if (alignment != 0x2) { | |
| /* | |
| * not 16bit aligned so use the room provided by | |
| * the 32 bit header to align the data | |
| * | |
| * note we want 16bit alignment as MAC header is | |
| * 14bytes thus ip header will be aligned on | |
| * 32bit boundary so accessing ipheader elements | |
| * using a cast to struct ip header wont cause | |
| * an unaligned accesses. | |
| */ | |
| u8 realignment = (alignment + 2) & 0x3; | |
| memmove(skb->data - realignment, | |
| skb->data, | |
| size); | |
| skb->data -= realignment; | |
| skb_set_tail_pointer(skb, size); | |
| } | |
| return 2; | |
| } | |
| if (size > dev->net->mtu + ETH_HLEN) { | |
| netdev_err(dev->net, "asix_rx_fixup() Bad RX Length %d\n", | |
| size); | |
| return 0; | |
| } | |
| ax_skb = skb_clone(skb, GFP_ATOMIC); | |
| if (ax_skb) { | |
| u8 alignment = (unsigned long)packet & 0x3; | |
| ax_skb->len = size; | |
| if (alignment != 0x2) { | |
| /* | |
| * not 16bit aligned use the room provided by | |
| * the 32 bit header to align the data | |
| */ | |
| u8 realignment = (alignment + 2) & 0x3; | |
| memmove(packet - realignment, packet, size); | |
| packet -= realignment; | |
| } | |
| ax_skb->data = packet; | |
| skb_set_tail_pointer(ax_skb, size); | |
| usbnet_skb_return(dev, ax_skb); | |
| } else { | |
| return 0; | |
| } | |
| skb_pull(skb, (size + 1) & 0xfffe); | |
| if (skb->len < sizeof(header)) | |
| 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, "asix_rx_fixup() Bad SKB Length %d\n", | |
| skb->len); | |
| return 0; | |
| } | |
| return 1; | |
| } | |
| static struct sk_buff *asix_tx_fixup(struct usbnet *dev, struct sk_buff *skb, | |
| gfp_t flags) | |
| { | |
| int padlen; | |
| int headroom = skb_headroom(skb); | |
| int tailroom = skb_tailroom(skb); | |
| u32 packet_len; | |
| u32 padbytes = 0xffff0000; | |
| padlen = ((skb->len + 4) & (dev->maxpacket - 1)) ? 0 : 4; | |
| 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 (padlen) { | |
| cpu_to_le32s(&padbytes); | |
| memcpy(skb_tail_pointer(skb), &padbytes, sizeof(padbytes)); | |
| skb_put(skb, sizeof(padbytes)); | |
| } | |
| return skb; | |
| } | |
| static void asix_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_dbg(dev->net, "Link Status is: %d\n", link); | |
| } | |
| } | |
| static inline int asix_set_sw_mii(struct usbnet *dev) | |
| { | |
| int ret; | |
| ret = asix_write_cmd(dev, AX_CMD_SET_SW_MII, 0x0000, 0, 0, NULL); | |
| if (ret < 0) | |
| netdev_err(dev->net, "Failed to enable software MII access\n"); | |
| return ret; | |
| } | |
| static inline int asix_set_hw_mii(struct usbnet *dev) | |
| { | |
| int ret; | |
| ret = asix_write_cmd(dev, AX_CMD_SET_HW_MII, 0x0000, 0, 0, NULL); | |
| if (ret < 0) | |
| netdev_err(dev->net, "Failed to enable hardware MII access\n"); | |
| return ret; | |
| } | |
| static inline int asix_get_phy_addr(struct usbnet *dev) | |
| { | |
| u8 buf[2]; | |
| int ret = asix_read_cmd(dev, AX_CMD_READ_PHY_ID, 0, 0, 2, buf); | |
| netdev_dbg(dev->net, "asix_get_phy_addr()\n"); | |
| if (ret < 0) { | |
| netdev_err(dev->net, "Error reading PHYID register: %02x\n", ret); | |
| goto out; | |
| } | |
| netdev_dbg(dev->net, "asix_get_phy_addr() returning 0x%04x\n", | |
| *((__le16 *)buf)); | |
| ret = buf[1]; | |
| out: | |
| return ret; | |
| } | |
| static int asix_sw_reset(struct usbnet *dev, u8 flags) | |
| { | |
| int ret; | |
| ret = asix_write_cmd(dev, AX_CMD_SW_RESET, flags, 0, 0, NULL); | |
| if (ret < 0) | |
| netdev_err(dev->net, "Failed to send software reset: %02x\n", ret); | |
| return ret; | |
| } | |
| static u16 asix_read_rx_ctl(struct usbnet *dev) | |
| { | |
| __le16 v; | |
| int ret = asix_read_cmd(dev, AX_CMD_READ_RX_CTL, 0, 0, 2, &v); | |
| if (ret < 0) { | |
| netdev_err(dev->net, "Error reading RX_CTL register: %02x\n", ret); | |
| goto out; | |
| } | |
| ret = le16_to_cpu(v); | |
| out: | |
| return ret; | |
| } | |
| static int asix_write_rx_ctl(struct usbnet *dev, u16 mode) | |
| { | |
| int ret; | |
| netdev_dbg(dev->net, "asix_write_rx_ctl() - mode = 0x%04x\n", mode); | |
| ret = asix_write_cmd(dev, AX_CMD_WRITE_RX_CTL, mode, 0, 0, NULL); | |
| if (ret < 0) | |
| netdev_err(dev->net, "Failed to write RX_CTL mode to 0x%04x: %02x\n", | |
| mode, ret); | |
| return ret; | |
| } | |
| static u16 asix_read_medium_status(struct usbnet *dev) | |
| { | |
| __le16 v; | |
| int ret = asix_read_cmd(dev, AX_CMD_READ_MEDIUM_STATUS, 0, 0, 2, &v); | |
| if (ret < 0) { | |
| netdev_err(dev->net, "Error reading Medium Status register: %02x\n", | |
| ret); | |
| goto out; | |
| } | |
| ret = le16_to_cpu(v); | |
| out: | |
| return ret; | |
| } | |
| static int asix_write_medium_mode(struct usbnet *dev, u16 mode) | |
| { | |
| int ret; | |
| netdev_dbg(dev->net, "asix_write_medium_mode() - mode = 0x%04x\n", mode); | |
| ret = asix_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL); | |
| if (ret < 0) | |
| netdev_err(dev->net, "Failed to write Medium Mode mode to 0x%04x: %02x\n", | |
| mode, ret); | |
| return ret; | |
| } | |
| static int asix_write_gpio(struct usbnet *dev, u16 value, int sleep) | |
| { | |
| int ret; | |
| netdev_dbg(dev->net, "asix_write_gpio() - value = 0x%04x\n", value); | |
| ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, value, 0, 0, NULL); | |
| if (ret < 0) | |
| netdev_err(dev->net, "Failed to write GPIO value 0x%04x: %02x\n", | |
| value, ret); | |
| if (sleep) | |
| msleep(sleep); | |
| return ret; | |
| } | |
| /* | |
| * AX88772 & AX88178 have a 16-bit RX_CTL value | |
| */ | |
| static void asix_set_multicast(struct net_device *net) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| u16 rx_ctl = AX_DEFAULT_RX_CTL; | |
| if (net->flags & IFF_PROMISC) { | |
| rx_ctl |= AX_RX_CTL_PRO; | |
| } else if (net->flags & IFF_ALLMULTI || | |
| netdev_mc_count(net) > AX_MAX_MCAST) { | |
| rx_ctl |= 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 */ | |
| struct netdev_hw_addr *ha; | |
| u32 crc_bits; | |
| memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE); | |
| /* Build the multicast hash filter. */ | |
| 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); | |
| } | |
| asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0, | |
| AX_MCAST_FILTER_SIZE, data->multi_filter); | |
| rx_ctl |= AX_RX_CTL_AM; | |
| } | |
| asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL); | |
| } | |
| static int asix_mdio_read(struct net_device *netdev, int phy_id, int loc) | |
| { | |
| struct usbnet *dev = netdev_priv(netdev); | |
| __le16 res; | |
| mutex_lock(&dev->phy_mutex); | |
| asix_set_sw_mii(dev); | |
| asix_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id, | |
| (__u16)loc, 2, &res); | |
| asix_set_hw_mii(dev); | |
| mutex_unlock(&dev->phy_mutex); | |
| netdev_dbg(dev->net, "asix_mdio_read() phy_id=0x%02x, loc=0x%02x, returns=0x%04x\n", | |
| phy_id, loc, le16_to_cpu(res)); | |
| return le16_to_cpu(res); | |
| } | |
| static void | |
| asix_mdio_write(struct net_device *netdev, int phy_id, int loc, int val) | |
| { | |
| struct usbnet *dev = netdev_priv(netdev); | |
| __le16 res = cpu_to_le16(val); | |
| netdev_dbg(dev->net, "asix_mdio_write() phy_id=0x%02x, loc=0x%02x, val=0x%04x\n", | |
| phy_id, loc, val); | |
| mutex_lock(&dev->phy_mutex); | |
| asix_set_sw_mii(dev); | |
| asix_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, (__u16)loc, 2, &res); | |
| asix_set_hw_mii(dev); | |
| mutex_unlock(&dev->phy_mutex); | |
| } | |
| /* Get the PHY Identifier from the PHYSID1 & PHYSID2 MII registers */ | |
| static u32 asix_get_phyid(struct usbnet *dev) | |
| { | |
| int phy_reg; | |
| u32 phy_id; | |
| phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID1); | |
| if (phy_reg < 0) | |
| return 0; | |
| phy_id = (phy_reg & 0xffff) << 16; | |
| phy_reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_PHYSID2); | |
| if (phy_reg < 0) | |
| return 0; | |
| phy_id |= (phy_reg & 0xffff); | |
| return phy_id; | |
| } | |
| static void | |
| asix_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| u8 opt; | |
| if (asix_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) { | |
| wolinfo->supported = 0; | |
| wolinfo->wolopts = 0; | |
| return; | |
| } | |
| wolinfo->supported = WAKE_PHY | WAKE_MAGIC; | |
| wolinfo->wolopts = 0; | |
| if (opt & AX_MONITOR_MODE) { | |
| if (opt & AX_MONITOR_LINK) | |
| wolinfo->wolopts |= WAKE_PHY; | |
| if (opt & AX_MONITOR_MAGIC) | |
| wolinfo->wolopts |= WAKE_MAGIC; | |
| } | |
| } | |
| static int | |
| asix_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_LINK; | |
| if (wolinfo->wolopts & WAKE_MAGIC) | |
| opt |= AX_MONITOR_MAGIC; | |
| if (opt != 0) | |
| opt |= AX_MONITOR_MODE; | |
| if (asix_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE, | |
| opt, 0, 0, NULL) < 0) | |
| return -EINVAL; | |
| return 0; | |
| } | |
| static int asix_get_eeprom_len(struct net_device *net) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| return data->eeprom_len; | |
| } | |
| static int asix_get_eeprom(struct net_device *net, | |
| struct ethtool_eeprom *eeprom, u8 *data) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| __le16 *ebuf = (__le16 *)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 (asix_read_cmd(dev, AX_CMD_READ_EEPROM, | |
| eeprom->offset + i, 0, 2, &ebuf[i]) < 0) | |
| return -EINVAL; | |
| } | |
| return 0; | |
| } | |
| static void asix_get_drvinfo (struct net_device *net, | |
| struct ethtool_drvinfo *info) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| /* Inherit standard device info */ | |
| usbnet_get_drvinfo(net, info); | |
| strncpy (info->driver, driver_name, sizeof info->driver); | |
| strncpy (info->version, DRIVER_VERSION, sizeof info->version); | |
| info->eedump_len = data->eeprom_len; | |
| } | |
| static u32 asix_get_link(struct net_device *net) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| return mii_link_ok(&dev->mii); | |
| } | |
| static int asix_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 int asix_set_mac_address(struct net_device *net, void *p) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| 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); | |
| /* We use the 20 byte dev->data | |
| * for our 6 byte mac buffer | |
| * to avoid allocating memory that | |
| * is tricky to free later */ | |
| memcpy(data->mac_addr, addr->sa_data, ETH_ALEN); | |
| asix_write_cmd_async(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN, | |
| data->mac_addr); | |
| return 0; | |
| } | |
| /* 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 const struct ethtool_ops ax88172_ethtool_ops = { | |
| .get_drvinfo = asix_get_drvinfo, | |
| .get_link = asix_get_link, | |
| .get_msglevel = usbnet_get_msglevel, | |
| .set_msglevel = usbnet_set_msglevel, | |
| .get_wol = asix_get_wol, | |
| .set_wol = asix_set_wol, | |
| .get_eeprom_len = asix_get_eeprom_len, | |
| .get_eeprom = asix_get_eeprom, | |
| .get_settings = usbnet_get_settings, | |
| .set_settings = usbnet_set_settings, | |
| .nway_reset = usbnet_nway_reset, | |
| }; | |
| static void ax88172_set_multicast(struct net_device *net) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| u8 rx_ctl = 0x8c; | |
| if (net->flags & IFF_PROMISC) { | |
| rx_ctl |= 0x01; | |
| } else if (net->flags & IFF_ALLMULTI || | |
| netdev_mc_count(net) > AX_MAX_MCAST) { | |
| rx_ctl |= 0x02; | |
| } 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 */ | |
| struct netdev_hw_addr *ha; | |
| u32 crc_bits; | |
| memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE); | |
| /* Build the multicast hash filter. */ | |
| 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); | |
| } | |
| asix_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0, | |
| AX_MCAST_FILTER_SIZE, data->multi_filter); | |
| rx_ctl |= 0x10; | |
| } | |
| asix_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL); | |
| } | |
| static int ax88172_link_reset(struct usbnet *dev) | |
| { | |
| u8 mode; | |
| struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET }; | |
| mii_check_media(&dev->mii, 1, 1); | |
| mii_ethtool_gset(&dev->mii, &ecmd); | |
| mode = AX88172_MEDIUM_DEFAULT; | |
| if (ecmd.duplex != DUPLEX_FULL) | |
| mode |= ~AX88172_MEDIUM_FD; | |
| netdev_dbg(dev->net, "ax88172_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n", | |
| ethtool_cmd_speed(&ecmd), ecmd.duplex, mode); | |
| asix_write_medium_mode(dev, mode); | |
| return 0; | |
| } | |
| static const struct net_device_ops ax88172_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_set_mac_address = eth_mac_addr, | |
| .ndo_validate_addr = eth_validate_addr, | |
| .ndo_do_ioctl = asix_ioctl, | |
| .ndo_set_multicast_list = ax88172_set_multicast, | |
| }; | |
| static int ax88172_bind(struct usbnet *dev, struct usb_interface *intf) | |
| { | |
| int ret = 0; | |
| u8 buf[ETH_ALEN]; | |
| int i; | |
| unsigned long gpio_bits = dev->driver_info->data; | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| data->eeprom_len = AX88172_EEPROM_LEN; | |
| usbnet_get_endpoints(dev,intf); | |
| /* Toggle the GPIOs in a manufacturer/model specific way */ | |
| for (i = 2; i >= 0; i--) { | |
| if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_GPIOS, | |
| (gpio_bits >> (i * 8)) & 0xff, 0, 0, | |
| NULL)) < 0) | |
| goto out; | |
| msleep(5); | |
| } | |
| if ((ret = asix_write_rx_ctl(dev, 0x80)) < 0) | |
| goto out; | |
| /* Get the MAC address */ | |
| if ((ret = asix_read_cmd(dev, AX88172_CMD_READ_NODE_ID, | |
| 0, 0, ETH_ALEN, buf)) < 0) { | |
| dbg("read AX_CMD_READ_NODE_ID failed: %d", ret); | |
| goto out; | |
| } | |
| memcpy(dev->net->dev_addr, buf, ETH_ALEN); | |
| /* Initialize MII structure */ | |
| dev->mii.dev = dev->net; | |
| dev->mii.mdio_read = asix_mdio_read; | |
| dev->mii.mdio_write = asix_mdio_write; | |
| dev->mii.phy_id_mask = 0x3f; | |
| dev->mii.reg_num_mask = 0x1f; | |
| dev->mii.phy_id = asix_get_phy_addr(dev); | |
| dev->net->netdev_ops = &ax88172_netdev_ops; | |
| dev->net->ethtool_ops = &ax88172_ethtool_ops; | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, | |
| ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP); | |
| mii_nway_restart(&dev->mii); | |
| return 0; | |
| out: | |
| return ret; | |
| } | |
| static const struct ethtool_ops ax88772_ethtool_ops = { | |
| .get_drvinfo = asix_get_drvinfo, | |
| .get_link = asix_get_link, | |
| .get_msglevel = usbnet_get_msglevel, | |
| .set_msglevel = usbnet_set_msglevel, | |
| .get_wol = asix_get_wol, | |
| .set_wol = asix_set_wol, | |
| .get_eeprom_len = asix_get_eeprom_len, | |
| .get_eeprom = asix_get_eeprom, | |
| .get_settings = usbnet_get_settings, | |
| .set_settings = usbnet_set_settings, | |
| .nway_reset = usbnet_nway_reset, | |
| }; | |
| static int ax88772_link_reset(struct usbnet *dev) | |
| { | |
| u16 mode; | |
| struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET }; | |
| mii_check_media(&dev->mii, 1, 1); | |
| mii_ethtool_gset(&dev->mii, &ecmd); | |
| mode = AX88772_MEDIUM_DEFAULT; | |
| if (ethtool_cmd_speed(&ecmd) != SPEED_100) | |
| mode &= ~AX_MEDIUM_PS; | |
| if (ecmd.duplex != DUPLEX_FULL) | |
| mode &= ~AX_MEDIUM_FD; | |
| netdev_dbg(dev->net, "ax88772_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n", | |
| ethtool_cmd_speed(&ecmd), ecmd.duplex, mode); | |
| asix_write_medium_mode(dev, mode); | |
| return 0; | |
| } | |
| static const struct net_device_ops ax88772_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_set_mac_address = asix_set_mac_address, | |
| .ndo_validate_addr = eth_validate_addr, | |
| .ndo_do_ioctl = asix_ioctl, | |
| .ndo_set_multicast_list = asix_set_multicast, | |
| }; | |
| static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf) | |
| { | |
| int ret, embd_phy; | |
| u16 rx_ctl; | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| u8 buf[ETH_ALEN]; | |
| u32 phyid; | |
| data->eeprom_len = AX88772_EEPROM_LEN; | |
| usbnet_get_endpoints(dev,intf); | |
| if ((ret = asix_write_gpio(dev, | |
| AX_GPIO_RSE | AX_GPIO_GPO_2 | AX_GPIO_GPO2EN, 5)) < 0) | |
| goto out; | |
| /* 0x10 is the phy id of the embedded 10/100 ethernet phy */ | |
| embd_phy = ((asix_get_phy_addr(dev) & 0x1f) == 0x10 ? 1 : 0); | |
| if ((ret = asix_write_cmd(dev, AX_CMD_SW_PHY_SELECT, | |
| embd_phy, 0, 0, NULL)) < 0) { | |
| dbg("Select PHY #1 failed: %d", ret); | |
| goto out; | |
| } | |
| if ((ret = asix_sw_reset(dev, AX_SWRESET_IPPD | AX_SWRESET_PRL)) < 0) | |
| goto out; | |
| msleep(150); | |
| if ((ret = asix_sw_reset(dev, AX_SWRESET_CLEAR)) < 0) | |
| goto out; | |
| msleep(150); | |
| if (embd_phy) { | |
| if ((ret = asix_sw_reset(dev, AX_SWRESET_IPRL)) < 0) | |
| goto out; | |
| } | |
| else { | |
| if ((ret = asix_sw_reset(dev, AX_SWRESET_PRTE)) < 0) | |
| goto out; | |
| } | |
| msleep(150); | |
| rx_ctl = asix_read_rx_ctl(dev); | |
| dbg("RX_CTL is 0x%04x after software reset", rx_ctl); | |
| if ((ret = asix_write_rx_ctl(dev, 0x0000)) < 0) | |
| goto out; | |
| rx_ctl = asix_read_rx_ctl(dev); | |
| dbg("RX_CTL is 0x%04x setting to 0x0000", rx_ctl); | |
| /* Get the MAC address */ | |
| if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, | |
| 0, 0, ETH_ALEN, buf)) < 0) { | |
| dbg("Failed to read MAC address: %d", ret); | |
| goto out; | |
| } | |
| memcpy(dev->net->dev_addr, buf, ETH_ALEN); | |
| /* Initialize MII structure */ | |
| dev->mii.dev = dev->net; | |
| dev->mii.mdio_read = asix_mdio_read; | |
| dev->mii.mdio_write = asix_mdio_write; | |
| dev->mii.phy_id_mask = 0x1f; | |
| dev->mii.reg_num_mask = 0x1f; | |
| dev->mii.phy_id = asix_get_phy_addr(dev); | |
| phyid = asix_get_phyid(dev); | |
| dbg("PHYID=0x%08x", phyid); | |
| if ((ret = asix_sw_reset(dev, AX_SWRESET_PRL)) < 0) | |
| goto out; | |
| msleep(150); | |
| if ((ret = asix_sw_reset(dev, AX_SWRESET_IPRL | AX_SWRESET_PRL)) < 0) | |
| goto out; | |
| msleep(150); | |
| dev->net->netdev_ops = &ax88772_netdev_ops; | |
| dev->net->ethtool_ops = &ax88772_ethtool_ops; | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, | |
| ADVERTISE_ALL | ADVERTISE_CSMA); | |
| mii_nway_restart(&dev->mii); | |
| if ((ret = asix_write_medium_mode(dev, AX88772_MEDIUM_DEFAULT)) < 0) | |
| goto out; | |
| if ((ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0, | |
| AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT, | |
| AX88772_IPG2_DEFAULT, 0, NULL)) < 0) { | |
| dbg("Write IPG,IPG1,IPG2 failed: %d", ret); | |
| goto out; | |
| } | |
| /* Set RX_CTL to default values with 2k buffer, and enable cactus */ | |
| if ((ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL)) < 0) | |
| goto out; | |
| rx_ctl = asix_read_rx_ctl(dev); | |
| dbg("RX_CTL is 0x%04x after all initializations", rx_ctl); | |
| rx_ctl = asix_read_medium_status(dev); | |
| dbg("Medium Status is 0x%04x after all initializations", rx_ctl); | |
| /* 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; | |
| } | |
| return 0; | |
| out: | |
| return ret; | |
| } | |
| static struct ethtool_ops ax88178_ethtool_ops = { | |
| .get_drvinfo = asix_get_drvinfo, | |
| .get_link = asix_get_link, | |
| .get_msglevel = usbnet_get_msglevel, | |
| .set_msglevel = usbnet_set_msglevel, | |
| .get_wol = asix_get_wol, | |
| .set_wol = asix_set_wol, | |
| .get_eeprom_len = asix_get_eeprom_len, | |
| .get_eeprom = asix_get_eeprom, | |
| .get_settings = usbnet_get_settings, | |
| .set_settings = usbnet_set_settings, | |
| .nway_reset = usbnet_nway_reset, | |
| }; | |
| static int marvell_phy_init(struct usbnet *dev) | |
| { | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| u16 reg; | |
| netdev_dbg(dev->net, "marvell_phy_init()\n"); | |
| reg = asix_mdio_read(dev->net, dev->mii.phy_id, MII_MARVELL_STATUS); | |
| netdev_dbg(dev->net, "MII_MARVELL_STATUS = 0x%04x\n", reg); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_MARVELL_CTRL, | |
| MARVELL_CTRL_RXDELAY | MARVELL_CTRL_TXDELAY); | |
| if (data->ledmode) { | |
| reg = asix_mdio_read(dev->net, dev->mii.phy_id, | |
| MII_MARVELL_LED_CTRL); | |
| netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (1) = 0x%04x\n", reg); | |
| reg &= 0xf8ff; | |
| reg |= (1 + 0x0100); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, | |
| MII_MARVELL_LED_CTRL, reg); | |
| reg = asix_mdio_read(dev->net, dev->mii.phy_id, | |
| MII_MARVELL_LED_CTRL); | |
| netdev_dbg(dev->net, "MII_MARVELL_LED_CTRL (2) = 0x%04x\n", reg); | |
| reg &= 0xfc0f; | |
| } | |
| return 0; | |
| } | |
| static int marvell_led_status(struct usbnet *dev, u16 speed) | |
| { | |
| u16 reg = asix_mdio_read(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL); | |
| netdev_dbg(dev->net, "marvell_led_status() read 0x%04x\n", reg); | |
| /* Clear out the center LED bits - 0x03F0 */ | |
| reg &= 0xfc0f; | |
| switch (speed) { | |
| case SPEED_1000: | |
| reg |= 0x03e0; | |
| break; | |
| case SPEED_100: | |
| reg |= 0x03b0; | |
| break; | |
| default: | |
| reg |= 0x02f0; | |
| } | |
| netdev_dbg(dev->net, "marvell_led_status() writing 0x%04x\n", reg); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MARVELL_LED_MANUAL, reg); | |
| return 0; | |
| } | |
| static int ax88178_link_reset(struct usbnet *dev) | |
| { | |
| u16 mode; | |
| struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET }; | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| u32 speed; | |
| netdev_dbg(dev->net, "ax88178_link_reset()\n"); | |
| mii_check_media(&dev->mii, 1, 1); | |
| mii_ethtool_gset(&dev->mii, &ecmd); | |
| mode = AX88178_MEDIUM_DEFAULT; | |
| speed = ethtool_cmd_speed(&ecmd); | |
| if (speed == SPEED_1000) | |
| mode |= AX_MEDIUM_GM; | |
| else if (speed == SPEED_100) | |
| mode |= AX_MEDIUM_PS; | |
| else | |
| mode &= ~(AX_MEDIUM_PS | AX_MEDIUM_GM); | |
| mode |= AX_MEDIUM_ENCK; | |
| if (ecmd.duplex == DUPLEX_FULL) | |
| mode |= AX_MEDIUM_FD; | |
| else | |
| mode &= ~AX_MEDIUM_FD; | |
| netdev_dbg(dev->net, "ax88178_link_reset() speed: %u duplex: %d setting mode to 0x%04x\n", | |
| speed, ecmd.duplex, mode); | |
| asix_write_medium_mode(dev, mode); | |
| if (data->phymode == PHY_MODE_MARVELL && data->ledmode) | |
| marvell_led_status(dev, speed); | |
| return 0; | |
| } | |
| static void ax88178_set_mfb(struct usbnet *dev) | |
| { | |
| u16 mfb = AX_RX_CTL_MFB_16384; | |
| u16 rxctl; | |
| u16 medium; | |
| int old_rx_urb_size = dev->rx_urb_size; | |
| if (dev->hard_mtu < 2048) { | |
| dev->rx_urb_size = 2048; | |
| mfb = AX_RX_CTL_MFB_2048; | |
| } else if (dev->hard_mtu < 4096) { | |
| dev->rx_urb_size = 4096; | |
| mfb = AX_RX_CTL_MFB_4096; | |
| } else if (dev->hard_mtu < 8192) { | |
| dev->rx_urb_size = 8192; | |
| mfb = AX_RX_CTL_MFB_8192; | |
| } else if (dev->hard_mtu < 16384) { | |
| dev->rx_urb_size = 16384; | |
| mfb = AX_RX_CTL_MFB_16384; | |
| } | |
| rxctl = asix_read_rx_ctl(dev); | |
| asix_write_rx_ctl(dev, (rxctl & ~AX_RX_CTL_MFB_16384) | mfb); | |
| medium = asix_read_medium_status(dev); | |
| if (dev->net->mtu > 1500) | |
| medium |= AX_MEDIUM_JFE; | |
| else | |
| medium &= ~AX_MEDIUM_JFE; | |
| asix_write_medium_mode(dev, medium); | |
| if (dev->rx_urb_size > old_rx_urb_size) | |
| usbnet_unlink_rx_urbs(dev); | |
| } | |
| static int ax88178_change_mtu(struct net_device *net, int new_mtu) | |
| { | |
| struct usbnet *dev = netdev_priv(net); | |
| int ll_mtu = new_mtu + net->hard_header_len + 4; | |
| netdev_dbg(dev->net, "ax88178_change_mtu() new_mtu=%d\n", new_mtu); | |
| if (new_mtu <= 0 || ll_mtu > 16384) | |
| return -EINVAL; | |
| if ((ll_mtu % dev->maxpacket) == 0) | |
| return -EDOM; | |
| net->mtu = new_mtu; | |
| dev->hard_mtu = net->mtu + net->hard_header_len; | |
| ax88178_set_mfb(dev); | |
| return 0; | |
| } | |
| static const struct net_device_ops ax88178_netdev_ops = { | |
| .ndo_open = usbnet_open, | |
| .ndo_stop = usbnet_stop, | |
| .ndo_start_xmit = usbnet_start_xmit, | |
| .ndo_tx_timeout = usbnet_tx_timeout, | |
| .ndo_set_mac_address = asix_set_mac_address, | |
| .ndo_validate_addr = eth_validate_addr, | |
| .ndo_set_multicast_list = asix_set_multicast, | |
| .ndo_do_ioctl = asix_ioctl, | |
| .ndo_change_mtu = ax88178_change_mtu, | |
| }; | |
| static int ax88178_bind(struct usbnet *dev, struct usb_interface *intf) | |
| { | |
| struct asix_data *data = (struct asix_data *)&dev->data; | |
| int ret; | |
| u8 buf[ETH_ALEN]; | |
| __le16 eeprom; | |
| u8 status; | |
| int gpio0 = 0; | |
| u32 phyid; | |
| usbnet_get_endpoints(dev,intf); | |
| asix_read_cmd(dev, AX_CMD_READ_GPIOS, 0, 0, 1, &status); | |
| dbg("GPIO Status: 0x%04x", status); | |
| asix_write_cmd(dev, AX_CMD_WRITE_ENABLE, 0, 0, 0, NULL); | |
| asix_read_cmd(dev, AX_CMD_READ_EEPROM, 0x0017, 0, 2, &eeprom); | |
| asix_write_cmd(dev, AX_CMD_WRITE_DISABLE, 0, 0, 0, NULL); | |
| dbg("EEPROM index 0x17 is 0x%04x", eeprom); | |
| if (eeprom == cpu_to_le16(0xffff)) { | |
| data->phymode = PHY_MODE_MARVELL; | |
| data->ledmode = 0; | |
| gpio0 = 1; | |
| } else { | |
| data->phymode = le16_to_cpu(eeprom) & 7; | |
| data->ledmode = le16_to_cpu(eeprom) >> 8; | |
| gpio0 = (le16_to_cpu(eeprom) & 0x80) ? 0 : 1; | |
| } | |
| dbg("GPIO0: %d, PhyMode: %d", gpio0, data->phymode); | |
| asix_write_gpio(dev, AX_GPIO_RSE | AX_GPIO_GPO_1 | AX_GPIO_GPO1EN, 40); | |
| if ((le16_to_cpu(eeprom) >> 8) != 1) { | |
| asix_write_gpio(dev, 0x003c, 30); | |
| asix_write_gpio(dev, 0x001c, 300); | |
| asix_write_gpio(dev, 0x003c, 30); | |
| } else { | |
| dbg("gpio phymode == 1 path"); | |
| asix_write_gpio(dev, AX_GPIO_GPO1EN, 30); | |
| asix_write_gpio(dev, AX_GPIO_GPO1EN | AX_GPIO_GPO_1, 30); | |
| } | |
| asix_sw_reset(dev, 0); | |
| msleep(150); | |
| asix_sw_reset(dev, AX_SWRESET_PRL | AX_SWRESET_IPPD); | |
| msleep(150); | |
| asix_write_rx_ctl(dev, 0); | |
| /* Get the MAC address */ | |
| if ((ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, | |
| 0, 0, ETH_ALEN, buf)) < 0) { | |
| dbg("Failed to read MAC address: %d", ret); | |
| goto out; | |
| } | |
| memcpy(dev->net->dev_addr, buf, ETH_ALEN); | |
| /* Initialize MII structure */ | |
| dev->mii.dev = dev->net; | |
| dev->mii.mdio_read = asix_mdio_read; | |
| dev->mii.mdio_write = asix_mdio_write; | |
| dev->mii.phy_id_mask = 0x1f; | |
| dev->mii.reg_num_mask = 0xff; | |
| dev->mii.supports_gmii = 1; | |
| dev->mii.phy_id = asix_get_phy_addr(dev); | |
| dev->net->netdev_ops = &ax88178_netdev_ops; | |
| dev->net->ethtool_ops = &ax88178_ethtool_ops; | |
| phyid = asix_get_phyid(dev); | |
| dbg("PHYID=0x%08x", phyid); | |
| if (data->phymode == PHY_MODE_MARVELL) { | |
| marvell_phy_init(dev); | |
| msleep(60); | |
| } | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, | |
| BMCR_RESET | BMCR_ANENABLE); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, | |
| ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP); | |
| asix_mdio_write(dev->net, dev->mii.phy_id, MII_CTRL1000, | |
| ADVERTISE_1000FULL); | |
| mii_nway_restart(&dev->mii); | |
| if ((ret = asix_write_medium_mode(dev, AX88178_MEDIUM_DEFAULT)) < 0) | |
| goto out; | |
| if ((ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL)) < 0) | |
| goto 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; | |
| } | |
| return 0; | |
| out: | |
| return ret; | |
| } | |
| static const struct driver_info ax8817x_info = { | |
| .description = "ASIX AX8817x USB 2.0 Ethernet", | |
| .bind = ax88172_bind, | |
| .status = asix_status, | |
| .link_reset = ax88172_link_reset, | |
| .reset = ax88172_link_reset, | |
| .flags = FLAG_ETHER | FLAG_LINK_INTR, | |
| .data = 0x00130103, | |
| }; | |
| static const struct driver_info dlink_dub_e100_info = { | |
| .description = "DLink DUB-E100 USB Ethernet", | |
| .bind = ax88172_bind, | |
| .status = asix_status, | |
| .link_reset = ax88172_link_reset, | |
| .reset = ax88172_link_reset, | |
| .flags = FLAG_ETHER | FLAG_LINK_INTR, | |
| .data = 0x009f9d9f, | |
| }; | |
| static const struct driver_info netgear_fa120_info = { | |
| .description = "Netgear FA-120 USB Ethernet", | |
| .bind = ax88172_bind, | |
| .status = asix_status, | |
| .link_reset = ax88172_link_reset, | |
| .reset = ax88172_link_reset, | |
| .flags = FLAG_ETHER | FLAG_LINK_INTR, | |
| .data = 0x00130103, | |
| }; | |
| static const struct driver_info hawking_uf200_info = { | |
| .description = "Hawking UF200 USB Ethernet", | |
| .bind = ax88172_bind, | |
| .status = asix_status, | |
| .link_reset = ax88172_link_reset, | |
| .reset = ax88172_link_reset, | |
| .flags = FLAG_ETHER | FLAG_LINK_INTR, | |
| .data = 0x001f1d1f, | |
| }; | |
| static const struct driver_info ax88772_info = { | |
| .description = "ASIX AX88772 USB 2.0 Ethernet", | |
| .bind = ax88772_bind, | |
| .status = asix_status, | |
| .link_reset = ax88772_link_reset, | |
| .reset = ax88772_link_reset, | |
| .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR, | |
| .rx_fixup = asix_rx_fixup, | |
| .tx_fixup = asix_tx_fixup, | |
| }; | |
| static const struct driver_info ax88178_info = { | |
| .description = "ASIX AX88178 USB 2.0 Ethernet", | |
| .bind = ax88178_bind, | |
| .status = asix_status, | |
| .link_reset = ax88178_link_reset, | |
| .reset = ax88178_link_reset, | |
| .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR, | |
| .rx_fixup = asix_rx_fixup, | |
| .tx_fixup = asix_tx_fixup, | |
| }; | |
| static const struct usb_device_id products [] = { | |
| { | |
| // 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, | |
| }, { | |
| // 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, | |
| }, { | |
| // Buffalo LUA-U2-GT 10/100/1000 | |
| USB_DEVICE (0x0411, 0x006e), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // Sitecom LN-029 "USB 2.0 10/100 Ethernet adapter" | |
| USB_DEVICE (0x6189, 0x182d), | |
| .driver_info = (unsigned long) &ax8817x_info, | |
| }, { | |
| // Sitecom LN-031 "USB 2.0 10/100/1000 Ethernet adapter" | |
| USB_DEVICE (0x0df6, 0x0056), | |
| .driver_info = (unsigned long) &ax88178_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, | |
| }, { | |
| // JVC MP-PRX1 Port Replicator | |
| USB_DEVICE (0x04f1, 0x3008), | |
| .driver_info = (unsigned long) &ax8817x_info, | |
| }, { | |
| // ASIX AX88772B 10/100 | |
| USB_DEVICE (0x0b95, 0x772b), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // ASIX AX88772 10/100 | |
| USB_DEVICE (0x0b95, 0x7720), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // ASIX AX88178 10/100/1000 | |
| USB_DEVICE (0x0b95, 0x1780), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // Logitec LAN-GTJ/U2A | |
| USB_DEVICE (0x0789, 0x0160), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // Linksys USB200M Rev 2 | |
| USB_DEVICE (0x13b1, 0x0018), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // 0Q0 cable ethernet | |
| USB_DEVICE (0x1557, 0x7720), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // DLink DUB-E100 H/W Ver B1 | |
| USB_DEVICE (0x07d1, 0x3c05), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // DLink DUB-E100 H/W Ver B1 Alternate | |
| USB_DEVICE (0x2001, 0x3c05), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // DLink DUB-E100 H/W Ver C1 | |
| USB_DEVICE (0x2001, 0x1a02), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // Linksys USB1000 | |
| USB_DEVICE (0x1737, 0x0039), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // IO-DATA ETG-US2 | |
| USB_DEVICE (0x04bb, 0x0930), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // Belkin F5D5055 | |
| USB_DEVICE(0x050d, 0x5055), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // Apple USB Ethernet Adapter | |
| USB_DEVICE(0x05ac, 0x1402), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // Cables-to-Go USB Ethernet Adapter | |
| USB_DEVICE(0x0b95, 0x772a), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // ABOCOM for pci | |
| USB_DEVICE(0x14ea, 0xab11), | |
| .driver_info = (unsigned long) &ax88178_info, | |
| }, { | |
| // ASIX 88772a | |
| USB_DEVICE(0x0db0, 0xa877), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, { | |
| // Asus USB Ethernet Adapter | |
| USB_DEVICE (0x0b95, 0x7e2b), | |
| .driver_info = (unsigned long) &ax88772_info, | |
| }, | |
| { }, // END | |
| }; | |
| MODULE_DEVICE_TABLE(usb, products); | |
| static struct usb_driver asix_driver = { | |
| .name = "asix", | |
| .id_table = products, | |
| .probe = usbnet_probe, | |
| .suspend = usbnet_suspend, | |
| .resume = usbnet_resume, | |
| .disconnect = usbnet_disconnect, | |
| .supports_autosuspend = 1, | |
| }; | |
| 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"); | |