12f7ca802SSteve Glendinning /*************************************************************************** 22f7ca802SSteve Glendinning * 32f7ca802SSteve Glendinning * Copyright (C) 2007-2008 SMSC 42f7ca802SSteve Glendinning * 52f7ca802SSteve Glendinning * This program is free software; you can redistribute it and/or 62f7ca802SSteve Glendinning * modify it under the terms of the GNU General Public License 72f7ca802SSteve Glendinning * as published by the Free Software Foundation; either version 2 82f7ca802SSteve Glendinning * of the License, or (at your option) any later version. 92f7ca802SSteve Glendinning * 102f7ca802SSteve Glendinning * This program is distributed in the hope that it will be useful, 112f7ca802SSteve Glendinning * but WITHOUT ANY WARRANTY; without even the implied warranty of 122f7ca802SSteve Glendinning * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 132f7ca802SSteve Glendinning * GNU General Public License for more details. 142f7ca802SSteve Glendinning * 152f7ca802SSteve Glendinning * You should have received a copy of the GNU General Public License 162f7ca802SSteve Glendinning * along with this program; if not, write to the Free Software 172f7ca802SSteve Glendinning * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. 182f7ca802SSteve Glendinning * 192f7ca802SSteve Glendinning *****************************************************************************/ 202f7ca802SSteve Glendinning 212f7ca802SSteve Glendinning #include <linux/module.h> 222f7ca802SSteve Glendinning #include <linux/kmod.h> 232f7ca802SSteve Glendinning #include <linux/init.h> 242f7ca802SSteve Glendinning #include <linux/netdevice.h> 252f7ca802SSteve Glendinning #include <linux/etherdevice.h> 262f7ca802SSteve Glendinning #include <linux/ethtool.h> 272f7ca802SSteve Glendinning #include <linux/mii.h> 282f7ca802SSteve Glendinning #include <linux/usb.h> 292f7ca802SSteve Glendinning #include <linux/crc32.h> 302f7ca802SSteve Glendinning #include <linux/usb/usbnet.h> 315a0e3ad6STejun Heo #include <linux/slab.h> 322f7ca802SSteve Glendinning #include "smsc95xx.h" 332f7ca802SSteve Glendinning 342f7ca802SSteve Glendinning #define SMSC_CHIPNAME "smsc95xx" 35f7b29271SSteve Glendinning #define SMSC_DRIVER_VERSION "1.0.4" 362f7ca802SSteve Glendinning #define HS_USB_PKT_SIZE (512) 372f7ca802SSteve Glendinning #define FS_USB_PKT_SIZE (64) 382f7ca802SSteve Glendinning #define DEFAULT_HS_BURST_CAP_SIZE (16 * 1024 + 5 * HS_USB_PKT_SIZE) 392f7ca802SSteve Glendinning #define DEFAULT_FS_BURST_CAP_SIZE (6 * 1024 + 33 * FS_USB_PKT_SIZE) 402f7ca802SSteve Glendinning #define DEFAULT_BULK_IN_DELAY (0x00002000) 412f7ca802SSteve Glendinning #define MAX_SINGLE_PACKET_SIZE (2048) 422f7ca802SSteve Glendinning #define LAN95XX_EEPROM_MAGIC (0x9500) 432f7ca802SSteve Glendinning #define EEPROM_MAC_OFFSET (0x01) 44f7b29271SSteve Glendinning #define DEFAULT_TX_CSUM_ENABLE (true) 452f7ca802SSteve Glendinning #define DEFAULT_RX_CSUM_ENABLE (true) 462f7ca802SSteve Glendinning #define SMSC95XX_INTERNAL_PHY_ID (1) 472f7ca802SSteve Glendinning #define SMSC95XX_TX_OVERHEAD (8) 48f7b29271SSteve Glendinning #define SMSC95XX_TX_OVERHEAD_CSUM (12) 492f7ca802SSteve Glendinning 50769ea6d8SSteve Glendinning #define check_warn(ret, fmt, args...) \ 51769ea6d8SSteve Glendinning ({ if (ret < 0) netdev_warn(dev->net, fmt, ##args); }) 52769ea6d8SSteve Glendinning 53769ea6d8SSteve Glendinning #define check_warn_return(ret, fmt, args...) \ 54769ea6d8SSteve Glendinning ({ if (ret < 0) { netdev_warn(dev->net, fmt, ##args); return ret; } }) 55769ea6d8SSteve Glendinning 56769ea6d8SSteve Glendinning #define check_warn_goto_done(ret, fmt, args...) \ 57769ea6d8SSteve Glendinning ({ if (ret < 0) { netdev_warn(dev->net, fmt, ##args); goto done; } }) 58769ea6d8SSteve Glendinning 592f7ca802SSteve Glendinning struct smsc95xx_priv { 602f7ca802SSteve Glendinning u32 mac_cr; 613c0f3c60SMarc Zyngier u32 hash_hi; 623c0f3c60SMarc Zyngier u32 hash_lo; 632f7ca802SSteve Glendinning spinlock_t mac_cr_lock; 642f7ca802SSteve Glendinning }; 652f7ca802SSteve Glendinning 662f7ca802SSteve Glendinning struct usb_context { 672f7ca802SSteve Glendinning struct usb_ctrlrequest req; 682f7ca802SSteve Glendinning struct usbnet *dev; 692f7ca802SSteve Glendinning }; 702f7ca802SSteve Glendinning 71eb939922SRusty Russell static bool turbo_mode = true; 722f7ca802SSteve Glendinning module_param(turbo_mode, bool, 0644); 732f7ca802SSteve Glendinning MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction"); 742f7ca802SSteve Glendinning 75769ea6d8SSteve Glendinning static int __must_check smsc95xx_read_reg(struct usbnet *dev, u32 index, 76769ea6d8SSteve Glendinning u32 *data) 772f7ca802SSteve Glendinning { 782f7ca802SSteve Glendinning u32 *buf = kmalloc(4, GFP_KERNEL); 792f7ca802SSteve Glendinning int ret; 802f7ca802SSteve Glendinning 812f7ca802SSteve Glendinning BUG_ON(!dev); 822f7ca802SSteve Glendinning 832f7ca802SSteve Glendinning if (!buf) 842f7ca802SSteve Glendinning return -ENOMEM; 852f7ca802SSteve Glendinning 862f7ca802SSteve Glendinning ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), 872f7ca802SSteve Glendinning USB_VENDOR_REQUEST_READ_REGISTER, 882f7ca802SSteve Glendinning USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 892f7ca802SSteve Glendinning 00, index, buf, 4, USB_CTRL_GET_TIMEOUT); 902f7ca802SSteve Glendinning 912f7ca802SSteve Glendinning if (unlikely(ret < 0)) 9260b86755SJoe Perches netdev_warn(dev->net, "Failed to read register index 0x%08x\n", index); 932f7ca802SSteve Glendinning 942f7ca802SSteve Glendinning le32_to_cpus(buf); 952f7ca802SSteve Glendinning *data = *buf; 962f7ca802SSteve Glendinning kfree(buf); 972f7ca802SSteve Glendinning 982f7ca802SSteve Glendinning return ret; 992f7ca802SSteve Glendinning } 1002f7ca802SSteve Glendinning 101769ea6d8SSteve Glendinning static int __must_check smsc95xx_write_reg(struct usbnet *dev, u32 index, 102769ea6d8SSteve Glendinning u32 data) 1032f7ca802SSteve Glendinning { 1042f7ca802SSteve Glendinning u32 *buf = kmalloc(4, GFP_KERNEL); 1052f7ca802SSteve Glendinning int ret; 1062f7ca802SSteve Glendinning 1072f7ca802SSteve Glendinning BUG_ON(!dev); 1082f7ca802SSteve Glendinning 1092f7ca802SSteve Glendinning if (!buf) 1102f7ca802SSteve Glendinning return -ENOMEM; 1112f7ca802SSteve Glendinning 1122f7ca802SSteve Glendinning *buf = data; 1132f7ca802SSteve Glendinning cpu_to_le32s(buf); 1142f7ca802SSteve Glendinning 1152f7ca802SSteve Glendinning ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), 1162f7ca802SSteve Glendinning USB_VENDOR_REQUEST_WRITE_REGISTER, 1172f7ca802SSteve Glendinning USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 1182f7ca802SSteve Glendinning 00, index, buf, 4, USB_CTRL_SET_TIMEOUT); 1192f7ca802SSteve Glendinning 1202f7ca802SSteve Glendinning if (unlikely(ret < 0)) 12160b86755SJoe Perches netdev_warn(dev->net, "Failed to write register index 0x%08x\n", index); 1222f7ca802SSteve Glendinning 1232f7ca802SSteve Glendinning kfree(buf); 1242f7ca802SSteve Glendinning 1252f7ca802SSteve Glendinning return ret; 1262f7ca802SSteve Glendinning } 1272f7ca802SSteve Glendinning 1282f7ca802SSteve Glendinning /* Loop until the read is completed with timeout 1292f7ca802SSteve Glendinning * called with phy_mutex held */ 130769ea6d8SSteve Glendinning static int __must_check smsc95xx_phy_wait_not_busy(struct usbnet *dev) 1312f7ca802SSteve Glendinning { 1322f7ca802SSteve Glendinning unsigned long start_time = jiffies; 1332f7ca802SSteve Glendinning u32 val; 134769ea6d8SSteve Glendinning int ret; 1352f7ca802SSteve Glendinning 1362f7ca802SSteve Glendinning do { 137769ea6d8SSteve Glendinning ret = smsc95xx_read_reg(dev, MII_ADDR, &val); 138769ea6d8SSteve Glendinning check_warn_return(ret, "Error reading MII_ACCESS"); 1392f7ca802SSteve Glendinning if (!(val & MII_BUSY_)) 1402f7ca802SSteve Glendinning return 0; 1412f7ca802SSteve Glendinning } while (!time_after(jiffies, start_time + HZ)); 1422f7ca802SSteve Glendinning 1432f7ca802SSteve Glendinning return -EIO; 1442f7ca802SSteve Glendinning } 1452f7ca802SSteve Glendinning 1462f7ca802SSteve Glendinning static int smsc95xx_mdio_read(struct net_device *netdev, int phy_id, int idx) 1472f7ca802SSteve Glendinning { 1482f7ca802SSteve Glendinning struct usbnet *dev = netdev_priv(netdev); 1492f7ca802SSteve Glendinning u32 val, addr; 150769ea6d8SSteve Glendinning int ret; 1512f7ca802SSteve Glendinning 1522f7ca802SSteve Glendinning mutex_lock(&dev->phy_mutex); 1532f7ca802SSteve Glendinning 1542f7ca802SSteve Glendinning /* confirm MII not busy */ 155769ea6d8SSteve Glendinning ret = smsc95xx_phy_wait_not_busy(dev); 156769ea6d8SSteve Glendinning check_warn_goto_done(ret, "MII is busy in smsc95xx_mdio_read"); 1572f7ca802SSteve Glendinning 1582f7ca802SSteve Glendinning /* set the address, index & direction (read from PHY) */ 1592f7ca802SSteve Glendinning phy_id &= dev->mii.phy_id_mask; 1602f7ca802SSteve Glendinning idx &= dev->mii.reg_num_mask; 1612f7ca802SSteve Glendinning addr = (phy_id << 11) | (idx << 6) | MII_READ_; 162769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, MII_ADDR, addr); 163769ea6d8SSteve Glendinning check_warn_goto_done(ret, "Error writing MII_ADDR"); 1642f7ca802SSteve Glendinning 165769ea6d8SSteve Glendinning ret = smsc95xx_phy_wait_not_busy(dev); 166769ea6d8SSteve Glendinning check_warn_goto_done(ret, "Timed out reading MII reg %02X", idx); 167769ea6d8SSteve Glendinning 168769ea6d8SSteve Glendinning ret = smsc95xx_read_reg(dev, MII_DATA, &val); 169769ea6d8SSteve Glendinning check_warn_goto_done(ret, "Error reading MII_DATA"); 170769ea6d8SSteve Glendinning 171769ea6d8SSteve Glendinning ret = (u16)(val & 0xFFFF); 172769ea6d8SSteve Glendinning 173769ea6d8SSteve Glendinning done: 1742f7ca802SSteve Glendinning mutex_unlock(&dev->phy_mutex); 175769ea6d8SSteve Glendinning return ret; 1762f7ca802SSteve Glendinning } 1772f7ca802SSteve Glendinning 1782f7ca802SSteve Glendinning static void smsc95xx_mdio_write(struct net_device *netdev, int phy_id, int idx, 1792f7ca802SSteve Glendinning int regval) 1802f7ca802SSteve Glendinning { 1812f7ca802SSteve Glendinning struct usbnet *dev = netdev_priv(netdev); 1822f7ca802SSteve Glendinning u32 val, addr; 183769ea6d8SSteve Glendinning int ret; 1842f7ca802SSteve Glendinning 1852f7ca802SSteve Glendinning mutex_lock(&dev->phy_mutex); 1862f7ca802SSteve Glendinning 1872f7ca802SSteve Glendinning /* confirm MII not busy */ 188769ea6d8SSteve Glendinning ret = smsc95xx_phy_wait_not_busy(dev); 189769ea6d8SSteve Glendinning check_warn_goto_done(ret, "MII is busy in smsc95xx_mdio_write"); 1902f7ca802SSteve Glendinning 1912f7ca802SSteve Glendinning val = regval; 192769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, MII_DATA, val); 193769ea6d8SSteve Glendinning check_warn_goto_done(ret, "Error writing MII_DATA"); 1942f7ca802SSteve Glendinning 1952f7ca802SSteve Glendinning /* set the address, index & direction (write to PHY) */ 1962f7ca802SSteve Glendinning phy_id &= dev->mii.phy_id_mask; 1972f7ca802SSteve Glendinning idx &= dev->mii.reg_num_mask; 1982f7ca802SSteve Glendinning addr = (phy_id << 11) | (idx << 6) | MII_WRITE_; 199769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, MII_ADDR, addr); 200769ea6d8SSteve Glendinning check_warn_goto_done(ret, "Error writing MII_ADDR"); 2012f7ca802SSteve Glendinning 202769ea6d8SSteve Glendinning ret = smsc95xx_phy_wait_not_busy(dev); 203769ea6d8SSteve Glendinning check_warn_goto_done(ret, "Timed out writing MII reg %02X", idx); 2042f7ca802SSteve Glendinning 205769ea6d8SSteve Glendinning done: 2062f7ca802SSteve Glendinning mutex_unlock(&dev->phy_mutex); 2072f7ca802SSteve Glendinning } 2082f7ca802SSteve Glendinning 209769ea6d8SSteve Glendinning static int __must_check smsc95xx_wait_eeprom(struct usbnet *dev) 2102f7ca802SSteve Glendinning { 2112f7ca802SSteve Glendinning unsigned long start_time = jiffies; 2122f7ca802SSteve Glendinning u32 val; 213769ea6d8SSteve Glendinning int ret; 2142f7ca802SSteve Glendinning 2152f7ca802SSteve Glendinning do { 216769ea6d8SSteve Glendinning ret = smsc95xx_read_reg(dev, E2P_CMD, &val); 217769ea6d8SSteve Glendinning check_warn_return(ret, "Error reading E2P_CMD"); 2182f7ca802SSteve Glendinning if (!(val & E2P_CMD_BUSY_) || (val & E2P_CMD_TIMEOUT_)) 2192f7ca802SSteve Glendinning break; 2202f7ca802SSteve Glendinning udelay(40); 2212f7ca802SSteve Glendinning } while (!time_after(jiffies, start_time + HZ)); 2222f7ca802SSteve Glendinning 2232f7ca802SSteve Glendinning if (val & (E2P_CMD_TIMEOUT_ | E2P_CMD_BUSY_)) { 22460b86755SJoe Perches netdev_warn(dev->net, "EEPROM read operation timeout\n"); 2252f7ca802SSteve Glendinning return -EIO; 2262f7ca802SSteve Glendinning } 2272f7ca802SSteve Glendinning 2282f7ca802SSteve Glendinning return 0; 2292f7ca802SSteve Glendinning } 2302f7ca802SSteve Glendinning 231769ea6d8SSteve Glendinning static int __must_check smsc95xx_eeprom_confirm_not_busy(struct usbnet *dev) 2322f7ca802SSteve Glendinning { 2332f7ca802SSteve Glendinning unsigned long start_time = jiffies; 2342f7ca802SSteve Glendinning u32 val; 235769ea6d8SSteve Glendinning int ret; 2362f7ca802SSteve Glendinning 2372f7ca802SSteve Glendinning do { 238769ea6d8SSteve Glendinning ret = smsc95xx_read_reg(dev, E2P_CMD, &val); 239769ea6d8SSteve Glendinning check_warn_return(ret, "Error reading E2P_CMD"); 2402f7ca802SSteve Glendinning 2412f7ca802SSteve Glendinning if (!(val & E2P_CMD_BUSY_)) 2422f7ca802SSteve Glendinning return 0; 2432f7ca802SSteve Glendinning 2442f7ca802SSteve Glendinning udelay(40); 2452f7ca802SSteve Glendinning } while (!time_after(jiffies, start_time + HZ)); 2462f7ca802SSteve Glendinning 24760b86755SJoe Perches netdev_warn(dev->net, "EEPROM is busy\n"); 2482f7ca802SSteve Glendinning return -EIO; 2492f7ca802SSteve Glendinning } 2502f7ca802SSteve Glendinning 2512f7ca802SSteve Glendinning static int smsc95xx_read_eeprom(struct usbnet *dev, u32 offset, u32 length, 2522f7ca802SSteve Glendinning u8 *data) 2532f7ca802SSteve Glendinning { 2542f7ca802SSteve Glendinning u32 val; 2552f7ca802SSteve Glendinning int i, ret; 2562f7ca802SSteve Glendinning 2572f7ca802SSteve Glendinning BUG_ON(!dev); 2582f7ca802SSteve Glendinning BUG_ON(!data); 2592f7ca802SSteve Glendinning 2602f7ca802SSteve Glendinning ret = smsc95xx_eeprom_confirm_not_busy(dev); 2612f7ca802SSteve Glendinning if (ret) 2622f7ca802SSteve Glendinning return ret; 2632f7ca802SSteve Glendinning 2642f7ca802SSteve Glendinning for (i = 0; i < length; i++) { 2652f7ca802SSteve Glendinning val = E2P_CMD_BUSY_ | E2P_CMD_READ_ | (offset & E2P_CMD_ADDR_); 266769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, E2P_CMD, val); 267769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing E2P_CMD"); 2682f7ca802SSteve Glendinning 2692f7ca802SSteve Glendinning ret = smsc95xx_wait_eeprom(dev); 2702f7ca802SSteve Glendinning if (ret < 0) 2712f7ca802SSteve Glendinning return ret; 2722f7ca802SSteve Glendinning 273769ea6d8SSteve Glendinning ret = smsc95xx_read_reg(dev, E2P_DATA, &val); 274769ea6d8SSteve Glendinning check_warn_return(ret, "Error reading E2P_DATA"); 2752f7ca802SSteve Glendinning 2762f7ca802SSteve Glendinning data[i] = val & 0xFF; 2772f7ca802SSteve Glendinning offset++; 2782f7ca802SSteve Glendinning } 2792f7ca802SSteve Glendinning 2802f7ca802SSteve Glendinning return 0; 2812f7ca802SSteve Glendinning } 2822f7ca802SSteve Glendinning 2832f7ca802SSteve Glendinning static int smsc95xx_write_eeprom(struct usbnet *dev, u32 offset, u32 length, 2842f7ca802SSteve Glendinning u8 *data) 2852f7ca802SSteve Glendinning { 2862f7ca802SSteve Glendinning u32 val; 2872f7ca802SSteve Glendinning int i, ret; 2882f7ca802SSteve Glendinning 2892f7ca802SSteve Glendinning BUG_ON(!dev); 2902f7ca802SSteve Glendinning BUG_ON(!data); 2912f7ca802SSteve Glendinning 2922f7ca802SSteve Glendinning ret = smsc95xx_eeprom_confirm_not_busy(dev); 2932f7ca802SSteve Glendinning if (ret) 2942f7ca802SSteve Glendinning return ret; 2952f7ca802SSteve Glendinning 2962f7ca802SSteve Glendinning /* Issue write/erase enable command */ 2972f7ca802SSteve Glendinning val = E2P_CMD_BUSY_ | E2P_CMD_EWEN_; 298769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, E2P_CMD, val); 299769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing E2P_DATA"); 3002f7ca802SSteve Glendinning 3012f7ca802SSteve Glendinning ret = smsc95xx_wait_eeprom(dev); 3022f7ca802SSteve Glendinning if (ret < 0) 3032f7ca802SSteve Glendinning return ret; 3042f7ca802SSteve Glendinning 3052f7ca802SSteve Glendinning for (i = 0; i < length; i++) { 3062f7ca802SSteve Glendinning 3072f7ca802SSteve Glendinning /* Fill data register */ 3082f7ca802SSteve Glendinning val = data[i]; 309769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, E2P_DATA, val); 310769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing E2P_DATA"); 3112f7ca802SSteve Glendinning 3122f7ca802SSteve Glendinning /* Send "write" command */ 3132f7ca802SSteve Glendinning val = E2P_CMD_BUSY_ | E2P_CMD_WRITE_ | (offset & E2P_CMD_ADDR_); 314769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, E2P_CMD, val); 315769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing E2P_CMD"); 3162f7ca802SSteve Glendinning 3172f7ca802SSteve Glendinning ret = smsc95xx_wait_eeprom(dev); 3182f7ca802SSteve Glendinning if (ret < 0) 3192f7ca802SSteve Glendinning return ret; 3202f7ca802SSteve Glendinning 3212f7ca802SSteve Glendinning offset++; 3222f7ca802SSteve Glendinning } 3232f7ca802SSteve Glendinning 3242f7ca802SSteve Glendinning return 0; 3252f7ca802SSteve Glendinning } 3262f7ca802SSteve Glendinning 327150a7fccSSteve Glendinning static void smsc95xx_async_cmd_callback(struct urb *urb) 3282f7ca802SSteve Glendinning { 3292f7ca802SSteve Glendinning struct usb_context *usb_context = urb->context; 3302f7ca802SSteve Glendinning struct usbnet *dev = usb_context->dev; 331c94cb314SOliver Neukum int status = urb->status; 3322f7ca802SSteve Glendinning 333769ea6d8SSteve Glendinning check_warn(status, "async callback failed with %d\n", status); 3342f7ca802SSteve Glendinning 3352f7ca802SSteve Glendinning kfree(usb_context); 3362f7ca802SSteve Glendinning usb_free_urb(urb); 3372f7ca802SSteve Glendinning } 3382f7ca802SSteve Glendinning 339769ea6d8SSteve Glendinning static int __must_check smsc95xx_write_reg_async(struct usbnet *dev, u16 index, 340769ea6d8SSteve Glendinning u32 *data) 3412f7ca802SSteve Glendinning { 3422f7ca802SSteve Glendinning struct usb_context *usb_context; 3432f7ca802SSteve Glendinning int status; 3442f7ca802SSteve Glendinning struct urb *urb; 3451d74a6bdSSteve Glendinning const u16 size = 4; 3462f7ca802SSteve Glendinning 3472f7ca802SSteve Glendinning urb = usb_alloc_urb(0, GFP_ATOMIC); 3482f7ca802SSteve Glendinning if (!urb) { 34960b86755SJoe Perches netdev_warn(dev->net, "Error allocating URB\n"); 3502f7ca802SSteve Glendinning return -ENOMEM; 3512f7ca802SSteve Glendinning } 3522f7ca802SSteve Glendinning 3532f7ca802SSteve Glendinning usb_context = kmalloc(sizeof(struct usb_context), GFP_ATOMIC); 3542f7ca802SSteve Glendinning if (usb_context == NULL) { 35560b86755SJoe Perches netdev_warn(dev->net, "Error allocating control msg\n"); 3562f7ca802SSteve Glendinning usb_free_urb(urb); 3572f7ca802SSteve Glendinning return -ENOMEM; 3582f7ca802SSteve Glendinning } 3592f7ca802SSteve Glendinning 3602f7ca802SSteve Glendinning usb_context->req.bRequestType = 3612f7ca802SSteve Glendinning USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE; 3622f7ca802SSteve Glendinning usb_context->req.bRequest = USB_VENDOR_REQUEST_WRITE_REGISTER; 3632f7ca802SSteve Glendinning usb_context->req.wValue = 00; 3641d74a6bdSSteve Glendinning usb_context->req.wIndex = cpu_to_le16(index); 3651d74a6bdSSteve Glendinning usb_context->req.wLength = cpu_to_le16(size); 3662f7ca802SSteve Glendinning 3672f7ca802SSteve Glendinning usb_fill_control_urb(urb, dev->udev, usb_sndctrlpipe(dev->udev, 0), 3682f7ca802SSteve Glendinning (void *)&usb_context->req, data, size, 369150a7fccSSteve Glendinning smsc95xx_async_cmd_callback, 3702f7ca802SSteve Glendinning (void *)usb_context); 3712f7ca802SSteve Glendinning 3722f7ca802SSteve Glendinning status = usb_submit_urb(urb, GFP_ATOMIC); 3732f7ca802SSteve Glendinning if (status < 0) { 37460b86755SJoe Perches netdev_warn(dev->net, "Error submitting control msg, sts=%d\n", 37560b86755SJoe Perches status); 3762f7ca802SSteve Glendinning kfree(usb_context); 3772f7ca802SSteve Glendinning usb_free_urb(urb); 3782f7ca802SSteve Glendinning } 3792f7ca802SSteve Glendinning 3802f7ca802SSteve Glendinning return status; 3812f7ca802SSteve Glendinning } 3822f7ca802SSteve Glendinning 3832f7ca802SSteve Glendinning /* returns hash bit number for given MAC address 3842f7ca802SSteve Glendinning * example: 3852f7ca802SSteve Glendinning * 01 00 5E 00 00 01 -> returns bit number 31 */ 3862f7ca802SSteve Glendinning static unsigned int smsc95xx_hash(char addr[ETH_ALEN]) 3872f7ca802SSteve Glendinning { 3882f7ca802SSteve Glendinning return (ether_crc(ETH_ALEN, addr) >> 26) & 0x3f; 3892f7ca802SSteve Glendinning } 3902f7ca802SSteve Glendinning 3912f7ca802SSteve Glendinning static void smsc95xx_set_multicast(struct net_device *netdev) 3922f7ca802SSteve Glendinning { 3932f7ca802SSteve Glendinning struct usbnet *dev = netdev_priv(netdev); 3942f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]); 3952f7ca802SSteve Glendinning unsigned long flags; 396769ea6d8SSteve Glendinning int ret; 3972f7ca802SSteve Glendinning 3983c0f3c60SMarc Zyngier pdata->hash_hi = 0; 3993c0f3c60SMarc Zyngier pdata->hash_lo = 0; 4003c0f3c60SMarc Zyngier 4012f7ca802SSteve Glendinning spin_lock_irqsave(&pdata->mac_cr_lock, flags); 4022f7ca802SSteve Glendinning 4032f7ca802SSteve Glendinning if (dev->net->flags & IFF_PROMISC) { 404a475f603SJoe Perches netif_dbg(dev, drv, dev->net, "promiscuous mode enabled\n"); 4052f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_PRMS_; 4062f7ca802SSteve Glendinning pdata->mac_cr &= ~(MAC_CR_MCPAS_ | MAC_CR_HPFILT_); 4072f7ca802SSteve Glendinning } else if (dev->net->flags & IFF_ALLMULTI) { 408a475f603SJoe Perches netif_dbg(dev, drv, dev->net, "receive all multicast enabled\n"); 4092f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_MCPAS_; 4102f7ca802SSteve Glendinning pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_HPFILT_); 4114cd24eafSJiri Pirko } else if (!netdev_mc_empty(dev->net)) { 41222bedad3SJiri Pirko struct netdev_hw_addr *ha; 4132f7ca802SSteve Glendinning 4142f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_HPFILT_; 4152f7ca802SSteve Glendinning pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_); 4162f7ca802SSteve Glendinning 41722bedad3SJiri Pirko netdev_for_each_mc_addr(ha, netdev) { 41822bedad3SJiri Pirko u32 bitnum = smsc95xx_hash(ha->addr); 4192f7ca802SSteve Glendinning u32 mask = 0x01 << (bitnum & 0x1F); 4202f7ca802SSteve Glendinning if (bitnum & 0x20) 4213c0f3c60SMarc Zyngier pdata->hash_hi |= mask; 4222f7ca802SSteve Glendinning else 4233c0f3c60SMarc Zyngier pdata->hash_lo |= mask; 4242f7ca802SSteve Glendinning } 4252f7ca802SSteve Glendinning 426a475f603SJoe Perches netif_dbg(dev, drv, dev->net, "HASHH=0x%08X, HASHL=0x%08X\n", 4273c0f3c60SMarc Zyngier pdata->hash_hi, pdata->hash_lo); 4282f7ca802SSteve Glendinning } else { 429a475f603SJoe Perches netif_dbg(dev, drv, dev->net, "receive own packets only\n"); 4302f7ca802SSteve Glendinning pdata->mac_cr &= 4312f7ca802SSteve Glendinning ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_ | MAC_CR_HPFILT_); 4322f7ca802SSteve Glendinning } 4332f7ca802SSteve Glendinning 4342f7ca802SSteve Glendinning spin_unlock_irqrestore(&pdata->mac_cr_lock, flags); 4352f7ca802SSteve Glendinning 4362f7ca802SSteve Glendinning /* Initiate async writes, as we can't wait for completion here */ 437769ea6d8SSteve Glendinning ret = smsc95xx_write_reg_async(dev, HASHH, &pdata->hash_hi); 438769ea6d8SSteve Glendinning check_warn(ret, "failed to initiate async write to HASHH"); 439769ea6d8SSteve Glendinning 440769ea6d8SSteve Glendinning ret = smsc95xx_write_reg_async(dev, HASHL, &pdata->hash_lo); 441769ea6d8SSteve Glendinning check_warn(ret, "failed to initiate async write to HASHL"); 442769ea6d8SSteve Glendinning 443769ea6d8SSteve Glendinning ret = smsc95xx_write_reg_async(dev, MAC_CR, &pdata->mac_cr); 444769ea6d8SSteve Glendinning check_warn(ret, "failed to initiate async write to MAC_CR"); 4452f7ca802SSteve Glendinning } 4462f7ca802SSteve Glendinning 447769ea6d8SSteve Glendinning static int smsc95xx_phy_update_flowcontrol(struct usbnet *dev, u8 duplex, 4482f7ca802SSteve Glendinning u16 lcladv, u16 rmtadv) 4492f7ca802SSteve Glendinning { 4502f7ca802SSteve Glendinning u32 flow, afc_cfg = 0; 4512f7ca802SSteve Glendinning 4522f7ca802SSteve Glendinning int ret = smsc95xx_read_reg(dev, AFC_CFG, &afc_cfg); 453769ea6d8SSteve Glendinning check_warn_return(ret, "Error reading AFC_CFG"); 4542f7ca802SSteve Glendinning 4552f7ca802SSteve Glendinning if (duplex == DUPLEX_FULL) { 456bc02ff95SSteve Glendinning u8 cap = mii_resolve_flowctrl_fdx(lcladv, rmtadv); 4572f7ca802SSteve Glendinning 4582f7ca802SSteve Glendinning if (cap & FLOW_CTRL_RX) 4592f7ca802SSteve Glendinning flow = 0xFFFF0002; 4602f7ca802SSteve Glendinning else 4612f7ca802SSteve Glendinning flow = 0; 4622f7ca802SSteve Glendinning 4632f7ca802SSteve Glendinning if (cap & FLOW_CTRL_TX) 4642f7ca802SSteve Glendinning afc_cfg |= 0xF; 4652f7ca802SSteve Glendinning else 4662f7ca802SSteve Glendinning afc_cfg &= ~0xF; 4672f7ca802SSteve Glendinning 468a475f603SJoe Perches netif_dbg(dev, link, dev->net, "rx pause %s, tx pause %s\n", 46960b86755SJoe Perches cap & FLOW_CTRL_RX ? "enabled" : "disabled", 47060b86755SJoe Perches cap & FLOW_CTRL_TX ? "enabled" : "disabled"); 4712f7ca802SSteve Glendinning } else { 472a475f603SJoe Perches netif_dbg(dev, link, dev->net, "half duplex\n"); 4732f7ca802SSteve Glendinning flow = 0; 4742f7ca802SSteve Glendinning afc_cfg |= 0xF; 4752f7ca802SSteve Glendinning } 4762f7ca802SSteve Glendinning 477769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, FLOW, flow); 478769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing FLOW"); 479769ea6d8SSteve Glendinning 480769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, AFC_CFG, afc_cfg); 481769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing AFC_CFG"); 482769ea6d8SSteve Glendinning 483769ea6d8SSteve Glendinning return 0; 4842f7ca802SSteve Glendinning } 4852f7ca802SSteve Glendinning 4862f7ca802SSteve Glendinning static int smsc95xx_link_reset(struct usbnet *dev) 4872f7ca802SSteve Glendinning { 4882f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]); 4892f7ca802SSteve Glendinning struct mii_if_info *mii = &dev->mii; 4908ae6dacaSDavid Decotigny struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET }; 4912f7ca802SSteve Glendinning unsigned long flags; 4922f7ca802SSteve Glendinning u16 lcladv, rmtadv; 493769ea6d8SSteve Glendinning int ret; 4942f7ca802SSteve Glendinning 4952f7ca802SSteve Glendinning /* clear interrupt status */ 496769ea6d8SSteve Glendinning ret = smsc95xx_mdio_read(dev->net, mii->phy_id, PHY_INT_SRC); 497769ea6d8SSteve Glendinning check_warn_return(ret, "Error reading PHY_INT_SRC"); 498769ea6d8SSteve Glendinning 499769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL_); 500769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing INT_STS"); 5012f7ca802SSteve Glendinning 5022f7ca802SSteve Glendinning mii_check_media(mii, 1, 1); 5032f7ca802SSteve Glendinning mii_ethtool_gset(&dev->mii, &ecmd); 5042f7ca802SSteve Glendinning lcladv = smsc95xx_mdio_read(dev->net, mii->phy_id, MII_ADVERTISE); 5052f7ca802SSteve Glendinning rmtadv = smsc95xx_mdio_read(dev->net, mii->phy_id, MII_LPA); 5062f7ca802SSteve Glendinning 5078ae6dacaSDavid Decotigny netif_dbg(dev, link, dev->net, 5088ae6dacaSDavid Decotigny "speed: %u duplex: %d lcladv: %04x rmtadv: %04x\n", 5098ae6dacaSDavid Decotigny ethtool_cmd_speed(&ecmd), ecmd.duplex, lcladv, rmtadv); 5102f7ca802SSteve Glendinning 5112f7ca802SSteve Glendinning spin_lock_irqsave(&pdata->mac_cr_lock, flags); 5122f7ca802SSteve Glendinning if (ecmd.duplex != DUPLEX_FULL) { 5132f7ca802SSteve Glendinning pdata->mac_cr &= ~MAC_CR_FDPX_; 5142f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_RCVOWN_; 5152f7ca802SSteve Glendinning } else { 5162f7ca802SSteve Glendinning pdata->mac_cr &= ~MAC_CR_RCVOWN_; 5172f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_FDPX_; 5182f7ca802SSteve Glendinning } 5192f7ca802SSteve Glendinning spin_unlock_irqrestore(&pdata->mac_cr_lock, flags); 5202f7ca802SSteve Glendinning 521769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr); 522769ea6d8SSteve Glendinning check_warn_return(ret, "Error writing MAC_CR"); 5232f7ca802SSteve Glendinning 524769ea6d8SSteve Glendinning ret = smsc95xx_phy_update_flowcontrol(dev, ecmd.duplex, lcladv, rmtadv); 525769ea6d8SSteve Glendinning check_warn_return(ret, "Error updating PHY flow control"); 5262f7ca802SSteve Glendinning 5272f7ca802SSteve Glendinning return 0; 5282f7ca802SSteve Glendinning } 5292f7ca802SSteve Glendinning 5302f7ca802SSteve Glendinning static void smsc95xx_status(struct usbnet *dev, struct urb *urb) 5312f7ca802SSteve Glendinning { 5322f7ca802SSteve Glendinning u32 intdata; 5332f7ca802SSteve Glendinning 5342f7ca802SSteve Glendinning if (urb->actual_length != 4) { 53560b86755SJoe Perches netdev_warn(dev->net, "unexpected urb length %d\n", 53660b86755SJoe Perches urb->actual_length); 5372f7ca802SSteve Glendinning return; 5382f7ca802SSteve Glendinning } 5392f7ca802SSteve Glendinning 5402f7ca802SSteve Glendinning memcpy(&intdata, urb->transfer_buffer, 4); 5411d74a6bdSSteve Glendinning le32_to_cpus(&intdata); 5422f7ca802SSteve Glendinning 543a475f603SJoe Perches netif_dbg(dev, link, dev->net, "intdata: 0x%08X\n", intdata); 5442f7ca802SSteve Glendinning 5452f7ca802SSteve Glendinning if (intdata & INT_ENP_PHY_INT_) 5462f7ca802SSteve Glendinning usbnet_defer_kevent(dev, EVENT_LINK_RESET); 5472f7ca802SSteve Glendinning else 54860b86755SJoe Perches netdev_warn(dev->net, "unexpected interrupt, intdata=0x%08X\n", 54960b86755SJoe Perches intdata); 5502f7ca802SSteve Glendinning } 5512f7ca802SSteve Glendinning 552f7b29271SSteve Glendinning /* Enable or disable Tx & Rx checksum offload engines */ 553c8f44affSMichał Mirosław static int smsc95xx_set_features(struct net_device *netdev, 554c8f44affSMichał Mirosław netdev_features_t features) 5552f7ca802SSteve Glendinning { 55678e47fe4SMichał Mirosław struct usbnet *dev = netdev_priv(netdev); 5572f7ca802SSteve Glendinning u32 read_buf; 55878e47fe4SMichał Mirosław int ret; 55978e47fe4SMichał Mirosław 56078e47fe4SMichał Mirosław ret = smsc95xx_read_reg(dev, COE_CR, &read_buf); 561769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read COE_CR: %d\n", ret); 5622f7ca802SSteve Glendinning 56378e47fe4SMichał Mirosław if (features & NETIF_F_HW_CSUM) 564f7b29271SSteve Glendinning read_buf |= Tx_COE_EN_; 565f7b29271SSteve Glendinning else 566f7b29271SSteve Glendinning read_buf &= ~Tx_COE_EN_; 567f7b29271SSteve Glendinning 56878e47fe4SMichał Mirosław if (features & NETIF_F_RXCSUM) 5692f7ca802SSteve Glendinning read_buf |= Rx_COE_EN_; 5702f7ca802SSteve Glendinning else 5712f7ca802SSteve Glendinning read_buf &= ~Rx_COE_EN_; 5722f7ca802SSteve Glendinning 5732f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, COE_CR, read_buf); 574769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write COE_CR: %d\n", ret); 5752f7ca802SSteve Glendinning 576a475f603SJoe Perches netif_dbg(dev, hw, dev->net, "COE_CR = 0x%08x\n", read_buf); 5772f7ca802SSteve Glendinning return 0; 5782f7ca802SSteve Glendinning } 5792f7ca802SSteve Glendinning 5802f7ca802SSteve Glendinning static int smsc95xx_ethtool_get_eeprom_len(struct net_device *net) 5812f7ca802SSteve Glendinning { 5822f7ca802SSteve Glendinning return MAX_EEPROM_SIZE; 5832f7ca802SSteve Glendinning } 5842f7ca802SSteve Glendinning 5852f7ca802SSteve Glendinning static int smsc95xx_ethtool_get_eeprom(struct net_device *netdev, 5862f7ca802SSteve Glendinning struct ethtool_eeprom *ee, u8 *data) 5872f7ca802SSteve Glendinning { 5882f7ca802SSteve Glendinning struct usbnet *dev = netdev_priv(netdev); 5892f7ca802SSteve Glendinning 5902f7ca802SSteve Glendinning ee->magic = LAN95XX_EEPROM_MAGIC; 5912f7ca802SSteve Glendinning 5922f7ca802SSteve Glendinning return smsc95xx_read_eeprom(dev, ee->offset, ee->len, data); 5932f7ca802SSteve Glendinning } 5942f7ca802SSteve Glendinning 5952f7ca802SSteve Glendinning static int smsc95xx_ethtool_set_eeprom(struct net_device *netdev, 5962f7ca802SSteve Glendinning struct ethtool_eeprom *ee, u8 *data) 5972f7ca802SSteve Glendinning { 5982f7ca802SSteve Glendinning struct usbnet *dev = netdev_priv(netdev); 5992f7ca802SSteve Glendinning 6002f7ca802SSteve Glendinning if (ee->magic != LAN95XX_EEPROM_MAGIC) { 60160b86755SJoe Perches netdev_warn(dev->net, "EEPROM: magic value mismatch, magic = 0x%x\n", 6022f7ca802SSteve Glendinning ee->magic); 6032f7ca802SSteve Glendinning return -EINVAL; 6042f7ca802SSteve Glendinning } 6052f7ca802SSteve Glendinning 6062f7ca802SSteve Glendinning return smsc95xx_write_eeprom(dev, ee->offset, ee->len, data); 6072f7ca802SSteve Glendinning } 6082f7ca802SSteve Glendinning 6099fa32e94SEmeric Vigier static int smsc95xx_ethtool_getregslen(struct net_device *netdev) 6109fa32e94SEmeric Vigier { 6119fa32e94SEmeric Vigier /* all smsc95xx registers */ 6129fa32e94SEmeric Vigier return COE_CR - ID_REV + 1; 6139fa32e94SEmeric Vigier } 6149fa32e94SEmeric Vigier 6159fa32e94SEmeric Vigier static void 6169fa32e94SEmeric Vigier smsc95xx_ethtool_getregs(struct net_device *netdev, struct ethtool_regs *regs, 6179fa32e94SEmeric Vigier void *buf) 6189fa32e94SEmeric Vigier { 6199fa32e94SEmeric Vigier struct usbnet *dev = netdev_priv(netdev); 620d348446bSDan Carpenter unsigned int i, j; 621d348446bSDan Carpenter int retval; 6229fa32e94SEmeric Vigier u32 *data = buf; 6239fa32e94SEmeric Vigier 6249fa32e94SEmeric Vigier retval = smsc95xx_read_reg(dev, ID_REV, ®s->version); 6259fa32e94SEmeric Vigier if (retval < 0) { 6269fa32e94SEmeric Vigier netdev_warn(netdev, "REGS: cannot read ID_REV\n"); 6279fa32e94SEmeric Vigier return; 6289fa32e94SEmeric Vigier } 6299fa32e94SEmeric Vigier 6309fa32e94SEmeric Vigier for (i = ID_REV, j = 0; i <= COE_CR; i += (sizeof(u32)), j++) { 6319fa32e94SEmeric Vigier retval = smsc95xx_read_reg(dev, i, &data[j]); 6329fa32e94SEmeric Vigier if (retval < 0) { 6339fa32e94SEmeric Vigier netdev_warn(netdev, "REGS: cannot read reg[%x]\n", i); 6349fa32e94SEmeric Vigier return; 6359fa32e94SEmeric Vigier } 6369fa32e94SEmeric Vigier } 6379fa32e94SEmeric Vigier } 6389fa32e94SEmeric Vigier 6390fc0b732SStephen Hemminger static const struct ethtool_ops smsc95xx_ethtool_ops = { 6402f7ca802SSteve Glendinning .get_link = usbnet_get_link, 6412f7ca802SSteve Glendinning .nway_reset = usbnet_nway_reset, 6422f7ca802SSteve Glendinning .get_drvinfo = usbnet_get_drvinfo, 6432f7ca802SSteve Glendinning .get_msglevel = usbnet_get_msglevel, 6442f7ca802SSteve Glendinning .set_msglevel = usbnet_set_msglevel, 6452f7ca802SSteve Glendinning .get_settings = usbnet_get_settings, 6462f7ca802SSteve Glendinning .set_settings = usbnet_set_settings, 6472f7ca802SSteve Glendinning .get_eeprom_len = smsc95xx_ethtool_get_eeprom_len, 6482f7ca802SSteve Glendinning .get_eeprom = smsc95xx_ethtool_get_eeprom, 6492f7ca802SSteve Glendinning .set_eeprom = smsc95xx_ethtool_set_eeprom, 6509fa32e94SEmeric Vigier .get_regs_len = smsc95xx_ethtool_getregslen, 6519fa32e94SEmeric Vigier .get_regs = smsc95xx_ethtool_getregs, 6522f7ca802SSteve Glendinning }; 6532f7ca802SSteve Glendinning 6542f7ca802SSteve Glendinning static int smsc95xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd) 6552f7ca802SSteve Glendinning { 6562f7ca802SSteve Glendinning struct usbnet *dev = netdev_priv(netdev); 6572f7ca802SSteve Glendinning 6582f7ca802SSteve Glendinning if (!netif_running(netdev)) 6592f7ca802SSteve Glendinning return -EINVAL; 6602f7ca802SSteve Glendinning 6612f7ca802SSteve Glendinning return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL); 6622f7ca802SSteve Glendinning } 6632f7ca802SSteve Glendinning 6642f7ca802SSteve Glendinning static void smsc95xx_init_mac_address(struct usbnet *dev) 6652f7ca802SSteve Glendinning { 6662f7ca802SSteve Glendinning /* try reading mac address from EEPROM */ 6672f7ca802SSteve Glendinning if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN, 6682f7ca802SSteve Glendinning dev->net->dev_addr) == 0) { 6692f7ca802SSteve Glendinning if (is_valid_ether_addr(dev->net->dev_addr)) { 6702f7ca802SSteve Glendinning /* eeprom values are valid so use them */ 671a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "MAC address read from EEPROM\n"); 6722f7ca802SSteve Glendinning return; 6732f7ca802SSteve Glendinning } 6742f7ca802SSteve Glendinning } 6752f7ca802SSteve Glendinning 6762f7ca802SSteve Glendinning /* no eeprom, or eeprom values are invalid. generate random MAC */ 677f2cedb63SDanny Kukawka eth_hw_addr_random(dev->net); 678c7e12eadSJoe Perches netif_dbg(dev, ifup, dev->net, "MAC address set to eth_random_addr\n"); 6792f7ca802SSteve Glendinning } 6802f7ca802SSteve Glendinning 6812f7ca802SSteve Glendinning static int smsc95xx_set_mac_address(struct usbnet *dev) 6822f7ca802SSteve Glendinning { 6832f7ca802SSteve Glendinning u32 addr_lo = dev->net->dev_addr[0] | dev->net->dev_addr[1] << 8 | 6842f7ca802SSteve Glendinning dev->net->dev_addr[2] << 16 | dev->net->dev_addr[3] << 24; 6852f7ca802SSteve Glendinning u32 addr_hi = dev->net->dev_addr[4] | dev->net->dev_addr[5] << 8; 6862f7ca802SSteve Glendinning int ret; 6872f7ca802SSteve Glendinning 6882f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, ADDRL, addr_lo); 689769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write ADDRL: %d\n", ret); 6902f7ca802SSteve Glendinning 6912f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, ADDRH, addr_hi); 692769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write ADDRH: %d\n", ret); 6932f7ca802SSteve Glendinning 6942f7ca802SSteve Glendinning return 0; 6952f7ca802SSteve Glendinning } 6962f7ca802SSteve Glendinning 6972f7ca802SSteve Glendinning /* starts the TX path */ 698769ea6d8SSteve Glendinning static int smsc95xx_start_tx_path(struct usbnet *dev) 6992f7ca802SSteve Glendinning { 7002f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]); 7012f7ca802SSteve Glendinning unsigned long flags; 702769ea6d8SSteve Glendinning int ret; 7032f7ca802SSteve Glendinning 7042f7ca802SSteve Glendinning /* Enable Tx at MAC */ 7052f7ca802SSteve Glendinning spin_lock_irqsave(&pdata->mac_cr_lock, flags); 7062f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_TXEN_; 7072f7ca802SSteve Glendinning spin_unlock_irqrestore(&pdata->mac_cr_lock, flags); 7082f7ca802SSteve Glendinning 709769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr); 710769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write MAC_CR: %d\n", ret); 7112f7ca802SSteve Glendinning 7122f7ca802SSteve Glendinning /* Enable Tx at SCSRs */ 713769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, TX_CFG, TX_CFG_ON_); 714769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write TX_CFG: %d\n", ret); 715769ea6d8SSteve Glendinning 716769ea6d8SSteve Glendinning return 0; 7172f7ca802SSteve Glendinning } 7182f7ca802SSteve Glendinning 7192f7ca802SSteve Glendinning /* Starts the Receive path */ 720769ea6d8SSteve Glendinning static int smsc95xx_start_rx_path(struct usbnet *dev) 7212f7ca802SSteve Glendinning { 7222f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]); 7232f7ca802SSteve Glendinning unsigned long flags; 724769ea6d8SSteve Glendinning int ret; 7252f7ca802SSteve Glendinning 7262f7ca802SSteve Glendinning spin_lock_irqsave(&pdata->mac_cr_lock, flags); 7272f7ca802SSteve Glendinning pdata->mac_cr |= MAC_CR_RXEN_; 7282f7ca802SSteve Glendinning spin_unlock_irqrestore(&pdata->mac_cr_lock, flags); 7292f7ca802SSteve Glendinning 730769ea6d8SSteve Glendinning ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr); 731769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write MAC_CR: %d\n", ret); 732769ea6d8SSteve Glendinning 733769ea6d8SSteve Glendinning return 0; 7342f7ca802SSteve Glendinning } 7352f7ca802SSteve Glendinning 7362f7ca802SSteve Glendinning static int smsc95xx_phy_initialize(struct usbnet *dev) 7372f7ca802SSteve Glendinning { 738769ea6d8SSteve Glendinning int bmcr, ret, timeout = 0; 739db443c44SSteve Glendinning 7402f7ca802SSteve Glendinning /* Initialize MII structure */ 7412f7ca802SSteve Glendinning dev->mii.dev = dev->net; 7422f7ca802SSteve Glendinning dev->mii.mdio_read = smsc95xx_mdio_read; 7432f7ca802SSteve Glendinning dev->mii.mdio_write = smsc95xx_mdio_write; 7442f7ca802SSteve Glendinning dev->mii.phy_id_mask = 0x1f; 7452f7ca802SSteve Glendinning dev->mii.reg_num_mask = 0x1f; 7462f7ca802SSteve Glendinning dev->mii.phy_id = SMSC95XX_INTERNAL_PHY_ID; 7472f7ca802SSteve Glendinning 748db443c44SSteve Glendinning /* reset phy and wait for reset to complete */ 7492f7ca802SSteve Glendinning smsc95xx_mdio_write(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET); 750db443c44SSteve Glendinning 751db443c44SSteve Glendinning do { 752db443c44SSteve Glendinning msleep(10); 753db443c44SSteve Glendinning bmcr = smsc95xx_mdio_read(dev->net, dev->mii.phy_id, MII_BMCR); 754db443c44SSteve Glendinning timeout++; 755d9460920SRabin Vincent } while ((bmcr & BMCR_RESET) && (timeout < 100)); 756db443c44SSteve Glendinning 757db443c44SSteve Glendinning if (timeout >= 100) { 758db443c44SSteve Glendinning netdev_warn(dev->net, "timeout on PHY Reset"); 759db443c44SSteve Glendinning return -EIO; 760db443c44SSteve Glendinning } 761db443c44SSteve Glendinning 7622f7ca802SSteve Glendinning smsc95xx_mdio_write(dev->net, dev->mii.phy_id, MII_ADVERTISE, 7632f7ca802SSteve Glendinning ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP | 7642f7ca802SSteve Glendinning ADVERTISE_PAUSE_ASYM); 7652f7ca802SSteve Glendinning 7662f7ca802SSteve Glendinning /* read to clear */ 767769ea6d8SSteve Glendinning ret = smsc95xx_mdio_read(dev->net, dev->mii.phy_id, PHY_INT_SRC); 768769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read PHY_INT_SRC during init"); 7692f7ca802SSteve Glendinning 7702f7ca802SSteve Glendinning smsc95xx_mdio_write(dev->net, dev->mii.phy_id, PHY_INT_MASK, 7712f7ca802SSteve Glendinning PHY_INT_MASK_DEFAULT_); 7722f7ca802SSteve Glendinning mii_nway_restart(&dev->mii); 7732f7ca802SSteve Glendinning 774a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "phy initialised successfully\n"); 7752f7ca802SSteve Glendinning return 0; 7762f7ca802SSteve Glendinning } 7772f7ca802SSteve Glendinning 7782f7ca802SSteve Glendinning static int smsc95xx_reset(struct usbnet *dev) 7792f7ca802SSteve Glendinning { 7802f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]); 7812f7ca802SSteve Glendinning u32 read_buf, write_buf, burst_cap; 7822f7ca802SSteve Glendinning int ret = 0, timeout; 7832f7ca802SSteve Glendinning 784a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "entering smsc95xx_reset\n"); 7852f7ca802SSteve Glendinning 7864436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, HW_CFG, HW_CFG_LRST_); 787769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write HW_CFG_LRST_ bit in HW_CFG\n"); 7882f7ca802SSteve Glendinning 7892f7ca802SSteve Glendinning timeout = 0; 7902f7ca802SSteve Glendinning do { 791cf2acec2SSteve Glendinning msleep(10); 7922f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf); 793769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read HW_CFG: %d\n", ret); 7942f7ca802SSteve Glendinning timeout++; 7952f7ca802SSteve Glendinning } while ((read_buf & HW_CFG_LRST_) && (timeout < 100)); 7962f7ca802SSteve Glendinning 7972f7ca802SSteve Glendinning if (timeout >= 100) { 79860b86755SJoe Perches netdev_warn(dev->net, "timeout waiting for completion of Lite Reset\n"); 7992f7ca802SSteve Glendinning return ret; 8002f7ca802SSteve Glendinning } 8012f7ca802SSteve Glendinning 8024436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, PM_CTRL, PM_CTL_PHY_RST_); 803769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write PM_CTRL: %d\n", ret); 8042f7ca802SSteve Glendinning 8052f7ca802SSteve Glendinning timeout = 0; 8062f7ca802SSteve Glendinning do { 807cf2acec2SSteve Glendinning msleep(10); 8082f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, PM_CTRL, &read_buf); 809769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read PM_CTRL: %d\n", ret); 8102f7ca802SSteve Glendinning timeout++; 8112f7ca802SSteve Glendinning } while ((read_buf & PM_CTL_PHY_RST_) && (timeout < 100)); 8122f7ca802SSteve Glendinning 8132f7ca802SSteve Glendinning if (timeout >= 100) { 81460b86755SJoe Perches netdev_warn(dev->net, "timeout waiting for PHY Reset\n"); 8152f7ca802SSteve Glendinning return ret; 8162f7ca802SSteve Glendinning } 8172f7ca802SSteve Glendinning 8182f7ca802SSteve Glendinning ret = smsc95xx_set_mac_address(dev); 8192f7ca802SSteve Glendinning if (ret < 0) 8202f7ca802SSteve Glendinning return ret; 8212f7ca802SSteve Glendinning 822a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 823a475f603SJoe Perches "MAC Address: %pM\n", dev->net->dev_addr); 8242f7ca802SSteve Glendinning 8252f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf); 826769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read HW_CFG: %d\n", ret); 8272f7ca802SSteve Glendinning 828a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 829a475f603SJoe Perches "Read Value from HW_CFG : 0x%08x\n", read_buf); 8302f7ca802SSteve Glendinning 8312f7ca802SSteve Glendinning read_buf |= HW_CFG_BIR_; 8322f7ca802SSteve Glendinning 8332f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, HW_CFG, read_buf); 834769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write HW_CFG_BIR_ bit in HW_CFG\n"); 8352f7ca802SSteve Glendinning 8362f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf); 837769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read HW_CFG: %d\n", ret); 838a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 839a475f603SJoe Perches "Read Value from HW_CFG after writing HW_CFG_BIR_: 0x%08x\n", 84060b86755SJoe Perches read_buf); 8412f7ca802SSteve Glendinning 8422f7ca802SSteve Glendinning if (!turbo_mode) { 8432f7ca802SSteve Glendinning burst_cap = 0; 8442f7ca802SSteve Glendinning dev->rx_urb_size = MAX_SINGLE_PACKET_SIZE; 8452f7ca802SSteve Glendinning } else if (dev->udev->speed == USB_SPEED_HIGH) { 8462f7ca802SSteve Glendinning burst_cap = DEFAULT_HS_BURST_CAP_SIZE / HS_USB_PKT_SIZE; 8472f7ca802SSteve Glendinning dev->rx_urb_size = DEFAULT_HS_BURST_CAP_SIZE; 8482f7ca802SSteve Glendinning } else { 8492f7ca802SSteve Glendinning burst_cap = DEFAULT_FS_BURST_CAP_SIZE / FS_USB_PKT_SIZE; 8502f7ca802SSteve Glendinning dev->rx_urb_size = DEFAULT_FS_BURST_CAP_SIZE; 8512f7ca802SSteve Glendinning } 8522f7ca802SSteve Glendinning 853a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 854a475f603SJoe Perches "rx_urb_size=%ld\n", (ulong)dev->rx_urb_size); 8552f7ca802SSteve Glendinning 8562f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, BURST_CAP, burst_cap); 857769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write BURST_CAP: %d\n", ret); 8582f7ca802SSteve Glendinning 8592f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, BURST_CAP, &read_buf); 860769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read BURST_CAP: %d\n", ret); 861769ea6d8SSteve Glendinning 862a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 863a475f603SJoe Perches "Read Value from BURST_CAP after writing: 0x%08x\n", 8642f7ca802SSteve Glendinning read_buf); 8652f7ca802SSteve Glendinning 8664436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, BULK_IN_DLY, DEFAULT_BULK_IN_DELAY); 867769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write BULK_IN_DLY: %d\n", ret); 8682f7ca802SSteve Glendinning 8692f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, BULK_IN_DLY, &read_buf); 870769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read BULK_IN_DLY: %d\n", ret); 871769ea6d8SSteve Glendinning 872a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 873a475f603SJoe Perches "Read Value from BULK_IN_DLY after writing: 0x%08x\n", 87460b86755SJoe Perches read_buf); 8752f7ca802SSteve Glendinning 8762f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf); 877769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read HW_CFG: %d\n", ret); 878769ea6d8SSteve Glendinning 879a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 880a475f603SJoe Perches "Read Value from HW_CFG: 0x%08x\n", read_buf); 8812f7ca802SSteve Glendinning 8822f7ca802SSteve Glendinning if (turbo_mode) 8832f7ca802SSteve Glendinning read_buf |= (HW_CFG_MEF_ | HW_CFG_BCE_); 8842f7ca802SSteve Glendinning 8852f7ca802SSteve Glendinning read_buf &= ~HW_CFG_RXDOFF_; 8862f7ca802SSteve Glendinning 8872f7ca802SSteve Glendinning /* set Rx data offset=2, Make IP header aligns on word boundary. */ 8882f7ca802SSteve Glendinning read_buf |= NET_IP_ALIGN << 9; 8892f7ca802SSteve Glendinning 8902f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, HW_CFG, read_buf); 891769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write HW_CFG: %d\n", ret); 8922f7ca802SSteve Glendinning 8932f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf); 894769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read HW_CFG: %d\n", ret); 895769ea6d8SSteve Glendinning 896a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, 897a475f603SJoe Perches "Read Value from HW_CFG after writing: 0x%08x\n", read_buf); 8982f7ca802SSteve Glendinning 8994436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL_); 900769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write INT_STS: %d\n", ret); 9012f7ca802SSteve Glendinning 9022f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, ID_REV, &read_buf); 903769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read ID_REV: %d\n", ret); 904a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "ID_REV = 0x%08x\n", read_buf); 9052f7ca802SSteve Glendinning 906f293501cSSteve Glendinning /* Configure GPIO pins as LED outputs */ 907f293501cSSteve Glendinning write_buf = LED_GPIO_CFG_SPD_LED | LED_GPIO_CFG_LNK_LED | 908f293501cSSteve Glendinning LED_GPIO_CFG_FDX_LED; 909f293501cSSteve Glendinning ret = smsc95xx_write_reg(dev, LED_GPIO_CFG, write_buf); 910769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write LED_GPIO_CFG: %d\n", ret); 911f293501cSSteve Glendinning 9122f7ca802SSteve Glendinning /* Init Tx */ 9134436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, FLOW, 0); 914769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write FLOW: %d\n", ret); 9152f7ca802SSteve Glendinning 9164436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, AFC_CFG, AFC_CFG_DEFAULT); 917769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write AFC_CFG: %d\n", ret); 9182f7ca802SSteve Glendinning 9192f7ca802SSteve Glendinning /* Don't need mac_cr_lock during initialisation */ 9202f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, MAC_CR, &pdata->mac_cr); 921769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read MAC_CR: %d\n", ret); 9222f7ca802SSteve Glendinning 9232f7ca802SSteve Glendinning /* Init Rx */ 9242f7ca802SSteve Glendinning /* Set Vlan */ 9254436761bSSteve Glendinning ret = smsc95xx_write_reg(dev, VLAN1, (u32)ETH_P_8021Q); 926769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write VLAN1: %d\n", ret); 9272f7ca802SSteve Glendinning 928f7b29271SSteve Glendinning /* Enable or disable checksum offload engines */ 929769ea6d8SSteve Glendinning ret = smsc95xx_set_features(dev->net, dev->net->features); 930769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to set checksum offload features"); 9312f7ca802SSteve Glendinning 9322f7ca802SSteve Glendinning smsc95xx_set_multicast(dev->net); 9332f7ca802SSteve Glendinning 934769ea6d8SSteve Glendinning ret = smsc95xx_phy_initialize(dev); 935769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to init PHY"); 9362f7ca802SSteve Glendinning 9372f7ca802SSteve Glendinning ret = smsc95xx_read_reg(dev, INT_EP_CTL, &read_buf); 938769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to read INT_EP_CTL: %d\n", ret); 9392f7ca802SSteve Glendinning 9402f7ca802SSteve Glendinning /* enable PHY interrupts */ 9412f7ca802SSteve Glendinning read_buf |= INT_EP_CTL_PHY_INT_; 9422f7ca802SSteve Glendinning 9432f7ca802SSteve Glendinning ret = smsc95xx_write_reg(dev, INT_EP_CTL, read_buf); 944769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to write INT_EP_CTL: %d\n", ret); 9452f7ca802SSteve Glendinning 946769ea6d8SSteve Glendinning ret = smsc95xx_start_tx_path(dev); 947769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to start TX path"); 948769ea6d8SSteve Glendinning 949769ea6d8SSteve Glendinning ret = smsc95xx_start_rx_path(dev); 950769ea6d8SSteve Glendinning check_warn_return(ret, "Failed to start RX path"); 9512f7ca802SSteve Glendinning 952a475f603SJoe Perches netif_dbg(dev, ifup, dev->net, "smsc95xx_reset, return 0\n"); 9532f7ca802SSteve Glendinning return 0; 9542f7ca802SSteve Glendinning } 9552f7ca802SSteve Glendinning 95663e77b39SStephen Hemminger static const struct net_device_ops smsc95xx_netdev_ops = { 95763e77b39SStephen Hemminger .ndo_open = usbnet_open, 95863e77b39SStephen Hemminger .ndo_stop = usbnet_stop, 95963e77b39SStephen Hemminger .ndo_start_xmit = usbnet_start_xmit, 96063e77b39SStephen Hemminger .ndo_tx_timeout = usbnet_tx_timeout, 96163e77b39SStephen Hemminger .ndo_change_mtu = usbnet_change_mtu, 96263e77b39SStephen Hemminger .ndo_set_mac_address = eth_mac_addr, 96363e77b39SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 96463e77b39SStephen Hemminger .ndo_do_ioctl = smsc95xx_ioctl, 965afc4b13dSJiri Pirko .ndo_set_rx_mode = smsc95xx_set_multicast, 96678e47fe4SMichał Mirosław .ndo_set_features = smsc95xx_set_features, 96763e77b39SStephen Hemminger }; 96863e77b39SStephen Hemminger 9692f7ca802SSteve Glendinning static int smsc95xx_bind(struct usbnet *dev, struct usb_interface *intf) 9702f7ca802SSteve Glendinning { 9712f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = NULL; 9722f7ca802SSteve Glendinning int ret; 9732f7ca802SSteve Glendinning 9742f7ca802SSteve Glendinning printk(KERN_INFO SMSC_CHIPNAME " v" SMSC_DRIVER_VERSION "\n"); 9752f7ca802SSteve Glendinning 9762f7ca802SSteve Glendinning ret = usbnet_get_endpoints(dev, intf); 977769ea6d8SSteve Glendinning check_warn_return(ret, "usbnet_get_endpoints failed: %d\n", ret); 9782f7ca802SSteve Glendinning 9792f7ca802SSteve Glendinning dev->data[0] = (unsigned long)kzalloc(sizeof(struct smsc95xx_priv), 9802f7ca802SSteve Glendinning GFP_KERNEL); 9812f7ca802SSteve Glendinning 9822f7ca802SSteve Glendinning pdata = (struct smsc95xx_priv *)(dev->data[0]); 9832f7ca802SSteve Glendinning if (!pdata) { 98460b86755SJoe Perches netdev_warn(dev->net, "Unable to allocate struct smsc95xx_priv\n"); 9852f7ca802SSteve Glendinning return -ENOMEM; 9862f7ca802SSteve Glendinning } 9872f7ca802SSteve Glendinning 9882f7ca802SSteve Glendinning spin_lock_init(&pdata->mac_cr_lock); 9892f7ca802SSteve Glendinning 99078e47fe4SMichał Mirosław if (DEFAULT_TX_CSUM_ENABLE) 99178e47fe4SMichał Mirosław dev->net->features |= NETIF_F_HW_CSUM; 99278e47fe4SMichał Mirosław if (DEFAULT_RX_CSUM_ENABLE) 99378e47fe4SMichał Mirosław dev->net->features |= NETIF_F_RXCSUM; 99478e47fe4SMichał Mirosław 99578e47fe4SMichał Mirosław dev->net->hw_features = NETIF_F_HW_CSUM | NETIF_F_RXCSUM; 9962f7ca802SSteve Glendinning 997f4e8ab7cSBernard Blackham smsc95xx_init_mac_address(dev); 998f4e8ab7cSBernard Blackham 9992f7ca802SSteve Glendinning /* Init all registers */ 10002f7ca802SSteve Glendinning ret = smsc95xx_reset(dev); 10012f7ca802SSteve Glendinning 100263e77b39SStephen Hemminger dev->net->netdev_ops = &smsc95xx_netdev_ops; 10032f7ca802SSteve Glendinning dev->net->ethtool_ops = &smsc95xx_ethtool_ops; 10042f7ca802SSteve Glendinning dev->net->flags |= IFF_MULTICAST; 100578e47fe4SMichał Mirosław dev->net->hard_header_len += SMSC95XX_TX_OVERHEAD_CSUM; 10069bbf5660SStephane Fillod dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len; 10072f7ca802SSteve Glendinning return 0; 10082f7ca802SSteve Glendinning } 10092f7ca802SSteve Glendinning 10102f7ca802SSteve Glendinning static void smsc95xx_unbind(struct usbnet *dev, struct usb_interface *intf) 10112f7ca802SSteve Glendinning { 10122f7ca802SSteve Glendinning struct smsc95xx_priv *pdata = (struct smsc95xx_priv *)(dev->data[0]); 10132f7ca802SSteve Glendinning if (pdata) { 1014a475f603SJoe Perches netif_dbg(dev, ifdown, dev->net, "free pdata\n"); 10152f7ca802SSteve Glendinning kfree(pdata); 10162f7ca802SSteve Glendinning pdata = NULL; 10172f7ca802SSteve Glendinning dev->data[0] = 0; 10182f7ca802SSteve Glendinning } 10192f7ca802SSteve Glendinning } 10202f7ca802SSteve Glendinning 1021*b5a04475SSteve Glendinning static int smsc95xx_suspend(struct usb_interface *intf, pm_message_t message) 1022*b5a04475SSteve Glendinning { 1023*b5a04475SSteve Glendinning struct usbnet *dev = usb_get_intfdata(intf); 1024*b5a04475SSteve Glendinning int ret; 1025*b5a04475SSteve Glendinning u32 val; 1026*b5a04475SSteve Glendinning 1027*b5a04475SSteve Glendinning if (WARN_ON_ONCE(!dev)) 1028*b5a04475SSteve Glendinning return -EINVAL; 1029*b5a04475SSteve Glendinning 1030*b5a04475SSteve Glendinning ret = usbnet_suspend(intf, message); 1031*b5a04475SSteve Glendinning check_warn_return(ret, "usbnet_suspend error"); 1032*b5a04475SSteve Glendinning 1033*b5a04475SSteve Glendinning netdev_info(dev->net, "entering SUSPEND2 mode"); 1034*b5a04475SSteve Glendinning 1035*b5a04475SSteve Glendinning ret = smsc95xx_read_reg(dev, PM_CTRL, &val); 1036*b5a04475SSteve Glendinning check_warn_return(ret, "Error reading PM_CTRL"); 1037*b5a04475SSteve Glendinning 1038*b5a04475SSteve Glendinning val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_); 1039*b5a04475SSteve Glendinning val |= PM_CTL_SUS_MODE_2; 1040*b5a04475SSteve Glendinning 1041*b5a04475SSteve Glendinning ret = smsc95xx_write_reg(dev, PM_CTRL, val); 1042*b5a04475SSteve Glendinning check_warn_return(ret, "Error writing PM_CTRL"); 1043*b5a04475SSteve Glendinning 1044*b5a04475SSteve Glendinning return 0; 1045*b5a04475SSteve Glendinning } 1046*b5a04475SSteve Glendinning 10472f7ca802SSteve Glendinning static void smsc95xx_rx_csum_offload(struct sk_buff *skb) 10482f7ca802SSteve Glendinning { 10492f7ca802SSteve Glendinning skb->csum = *(u16 *)(skb_tail_pointer(skb) - 2); 10502f7ca802SSteve Glendinning skb->ip_summed = CHECKSUM_COMPLETE; 10512f7ca802SSteve Glendinning skb_trim(skb, skb->len - 2); 10522f7ca802SSteve Glendinning } 10532f7ca802SSteve Glendinning 10542f7ca802SSteve Glendinning static int smsc95xx_rx_fixup(struct usbnet *dev, struct sk_buff *skb) 10552f7ca802SSteve Glendinning { 10562f7ca802SSteve Glendinning while (skb->len > 0) { 10572f7ca802SSteve Glendinning u32 header, align_count; 10582f7ca802SSteve Glendinning struct sk_buff *ax_skb; 10592f7ca802SSteve Glendinning unsigned char *packet; 10602f7ca802SSteve Glendinning u16 size; 10612f7ca802SSteve Glendinning 10622f7ca802SSteve Glendinning memcpy(&header, skb->data, sizeof(header)); 10632f7ca802SSteve Glendinning le32_to_cpus(&header); 10642f7ca802SSteve Glendinning skb_pull(skb, 4 + NET_IP_ALIGN); 10652f7ca802SSteve Glendinning packet = skb->data; 10662f7ca802SSteve Glendinning 10672f7ca802SSteve Glendinning /* get the packet length */ 10682f7ca802SSteve Glendinning size = (u16)((header & RX_STS_FL_) >> 16); 10692f7ca802SSteve Glendinning align_count = (4 - ((size + NET_IP_ALIGN) % 4)) % 4; 10702f7ca802SSteve Glendinning 10712f7ca802SSteve Glendinning if (unlikely(header & RX_STS_ES_)) { 1072a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 1073a475f603SJoe Perches "Error header=0x%08x\n", header); 107480667ac1SHerbert Xu dev->net->stats.rx_errors++; 107580667ac1SHerbert Xu dev->net->stats.rx_dropped++; 10762f7ca802SSteve Glendinning 10772f7ca802SSteve Glendinning if (header & RX_STS_CRC_) { 107880667ac1SHerbert Xu dev->net->stats.rx_crc_errors++; 10792f7ca802SSteve Glendinning } else { 10802f7ca802SSteve Glendinning if (header & (RX_STS_TL_ | RX_STS_RF_)) 108180667ac1SHerbert Xu dev->net->stats.rx_frame_errors++; 10822f7ca802SSteve Glendinning 10832f7ca802SSteve Glendinning if ((header & RX_STS_LE_) && 10842f7ca802SSteve Glendinning (!(header & RX_STS_FT_))) 108580667ac1SHerbert Xu dev->net->stats.rx_length_errors++; 10862f7ca802SSteve Glendinning } 10872f7ca802SSteve Glendinning } else { 10882f7ca802SSteve Glendinning /* ETH_FRAME_LEN + 4(CRC) + 2(COE) + 4(Vlan) */ 10892f7ca802SSteve Glendinning if (unlikely(size > (ETH_FRAME_LEN + 12))) { 1090a475f603SJoe Perches netif_dbg(dev, rx_err, dev->net, 1091a475f603SJoe Perches "size err header=0x%08x\n", header); 10922f7ca802SSteve Glendinning return 0; 10932f7ca802SSteve Glendinning } 10942f7ca802SSteve Glendinning 10952f7ca802SSteve Glendinning /* last frame in this batch */ 10962f7ca802SSteve Glendinning if (skb->len == size) { 109778e47fe4SMichał Mirosław if (dev->net->features & NETIF_F_RXCSUM) 10982f7ca802SSteve Glendinning smsc95xx_rx_csum_offload(skb); 1099df18accaSPeter Korsgaard skb_trim(skb, skb->len - 4); /* remove fcs */ 11002f7ca802SSteve Glendinning skb->truesize = size + sizeof(struct sk_buff); 11012f7ca802SSteve Glendinning 11022f7ca802SSteve Glendinning return 1; 11032f7ca802SSteve Glendinning } 11042f7ca802SSteve Glendinning 11052f7ca802SSteve Glendinning ax_skb = skb_clone(skb, GFP_ATOMIC); 11062f7ca802SSteve Glendinning if (unlikely(!ax_skb)) { 110760b86755SJoe Perches netdev_warn(dev->net, "Error allocating skb\n"); 11082f7ca802SSteve Glendinning return 0; 11092f7ca802SSteve Glendinning } 11102f7ca802SSteve Glendinning 11112f7ca802SSteve Glendinning ax_skb->len = size; 11122f7ca802SSteve Glendinning ax_skb->data = packet; 11132f7ca802SSteve Glendinning skb_set_tail_pointer(ax_skb, size); 11142f7ca802SSteve Glendinning 111578e47fe4SMichał Mirosław if (dev->net->features & NETIF_F_RXCSUM) 11162f7ca802SSteve Glendinning smsc95xx_rx_csum_offload(ax_skb); 1117df18accaSPeter Korsgaard skb_trim(ax_skb, ax_skb->len - 4); /* remove fcs */ 11182f7ca802SSteve Glendinning ax_skb->truesize = size + sizeof(struct sk_buff); 11192f7ca802SSteve Glendinning 11202f7ca802SSteve Glendinning usbnet_skb_return(dev, ax_skb); 11212f7ca802SSteve Glendinning } 11222f7ca802SSteve Glendinning 11232f7ca802SSteve Glendinning skb_pull(skb, size); 11242f7ca802SSteve Glendinning 11252f7ca802SSteve Glendinning /* padding bytes before the next frame starts */ 11262f7ca802SSteve Glendinning if (skb->len) 11272f7ca802SSteve Glendinning skb_pull(skb, align_count); 11282f7ca802SSteve Glendinning } 11292f7ca802SSteve Glendinning 11302f7ca802SSteve Glendinning if (unlikely(skb->len < 0)) { 113160b86755SJoe Perches netdev_warn(dev->net, "invalid rx length<0 %d\n", skb->len); 11322f7ca802SSteve Glendinning return 0; 11332f7ca802SSteve Glendinning } 11342f7ca802SSteve Glendinning 11352f7ca802SSteve Glendinning return 1; 11362f7ca802SSteve Glendinning } 11372f7ca802SSteve Glendinning 1138f7b29271SSteve Glendinning static u32 smsc95xx_calc_csum_preamble(struct sk_buff *skb) 1139f7b29271SSteve Glendinning { 114055508d60SMichał Mirosław u16 low_16 = (u16)skb_checksum_start_offset(skb); 114155508d60SMichał Mirosław u16 high_16 = low_16 + skb->csum_offset; 1142f7b29271SSteve Glendinning return (high_16 << 16) | low_16; 1143f7b29271SSteve Glendinning } 1144f7b29271SSteve Glendinning 11452f7ca802SSteve Glendinning static struct sk_buff *smsc95xx_tx_fixup(struct usbnet *dev, 11462f7ca802SSteve Glendinning struct sk_buff *skb, gfp_t flags) 11472f7ca802SSteve Glendinning { 114878e47fe4SMichał Mirosław bool csum = skb->ip_summed == CHECKSUM_PARTIAL; 1149f7b29271SSteve Glendinning int overhead = csum ? SMSC95XX_TX_OVERHEAD_CSUM : SMSC95XX_TX_OVERHEAD; 11502f7ca802SSteve Glendinning u32 tx_cmd_a, tx_cmd_b; 11512f7ca802SSteve Glendinning 1152f7b29271SSteve Glendinning /* We do not advertise SG, so skbs should be already linearized */ 1153f7b29271SSteve Glendinning BUG_ON(skb_shinfo(skb)->nr_frags); 1154f7b29271SSteve Glendinning 1155f7b29271SSteve Glendinning if (skb_headroom(skb) < overhead) { 11562f7ca802SSteve Glendinning struct sk_buff *skb2 = skb_copy_expand(skb, 1157f7b29271SSteve Glendinning overhead, 0, flags); 11582f7ca802SSteve Glendinning dev_kfree_skb_any(skb); 11592f7ca802SSteve Glendinning skb = skb2; 11602f7ca802SSteve Glendinning if (!skb) 11612f7ca802SSteve Glendinning return NULL; 11622f7ca802SSteve Glendinning } 11632f7ca802SSteve Glendinning 1164f7b29271SSteve Glendinning if (csum) { 116511bc3088SSteve Glendinning if (skb->len <= 45) { 116611bc3088SSteve Glendinning /* workaround - hardware tx checksum does not work 116711bc3088SSteve Glendinning * properly with extremely small packets */ 116855508d60SMichał Mirosław long csstart = skb_checksum_start_offset(skb); 116911bc3088SSteve Glendinning __wsum calc = csum_partial(skb->data + csstart, 117011bc3088SSteve Glendinning skb->len - csstart, 0); 117111bc3088SSteve Glendinning *((__sum16 *)(skb->data + csstart 117211bc3088SSteve Glendinning + skb->csum_offset)) = csum_fold(calc); 117311bc3088SSteve Glendinning 117411bc3088SSteve Glendinning csum = false; 117511bc3088SSteve Glendinning } else { 1176f7b29271SSteve Glendinning u32 csum_preamble = smsc95xx_calc_csum_preamble(skb); 1177f7b29271SSteve Glendinning skb_push(skb, 4); 1178f7b29271SSteve Glendinning memcpy(skb->data, &csum_preamble, 4); 1179f7b29271SSteve Glendinning } 118011bc3088SSteve Glendinning } 1181f7b29271SSteve Glendinning 11822f7ca802SSteve Glendinning skb_push(skb, 4); 11832f7ca802SSteve Glendinning tx_cmd_b = (u32)(skb->len - 4); 1184f7b29271SSteve Glendinning if (csum) 1185f7b29271SSteve Glendinning tx_cmd_b |= TX_CMD_B_CSUM_ENABLE; 11862f7ca802SSteve Glendinning cpu_to_le32s(&tx_cmd_b); 11872f7ca802SSteve Glendinning memcpy(skb->data, &tx_cmd_b, 4); 11882f7ca802SSteve Glendinning 11892f7ca802SSteve Glendinning skb_push(skb, 4); 11902f7ca802SSteve Glendinning tx_cmd_a = (u32)(skb->len - 8) | TX_CMD_A_FIRST_SEG_ | 11912f7ca802SSteve Glendinning TX_CMD_A_LAST_SEG_; 11922f7ca802SSteve Glendinning cpu_to_le32s(&tx_cmd_a); 11932f7ca802SSteve Glendinning memcpy(skb->data, &tx_cmd_a, 4); 11942f7ca802SSteve Glendinning 11952f7ca802SSteve Glendinning return skb; 11962f7ca802SSteve Glendinning } 11972f7ca802SSteve Glendinning 11982f7ca802SSteve Glendinning static const struct driver_info smsc95xx_info = { 11992f7ca802SSteve Glendinning .description = "smsc95xx USB 2.0 Ethernet", 12002f7ca802SSteve Glendinning .bind = smsc95xx_bind, 12012f7ca802SSteve Glendinning .unbind = smsc95xx_unbind, 12022f7ca802SSteve Glendinning .link_reset = smsc95xx_link_reset, 12032f7ca802SSteve Glendinning .reset = smsc95xx_reset, 12042f7ca802SSteve Glendinning .rx_fixup = smsc95xx_rx_fixup, 12052f7ca802SSteve Glendinning .tx_fixup = smsc95xx_tx_fixup, 12062f7ca802SSteve Glendinning .status = smsc95xx_status, 120707d69d42SPaolo Pisati .flags = FLAG_ETHER | FLAG_SEND_ZLP | FLAG_LINK_INTR, 12082f7ca802SSteve Glendinning }; 12092f7ca802SSteve Glendinning 12102f7ca802SSteve Glendinning static const struct usb_device_id products[] = { 12112f7ca802SSteve Glendinning { 12122f7ca802SSteve Glendinning /* SMSC9500 USB Ethernet Device */ 12132f7ca802SSteve Glendinning USB_DEVICE(0x0424, 0x9500), 12142f7ca802SSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12152f7ca802SSteve Glendinning }, 1216726474b8SSteve Glendinning { 12176f41d12bSSteve Glendinning /* SMSC9505 USB Ethernet Device */ 12186f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9505), 12196f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12206f41d12bSSteve Glendinning }, 12216f41d12bSSteve Glendinning { 12226f41d12bSSteve Glendinning /* SMSC9500A USB Ethernet Device */ 12236f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9E00), 12246f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12256f41d12bSSteve Glendinning }, 12266f41d12bSSteve Glendinning { 12276f41d12bSSteve Glendinning /* SMSC9505A USB Ethernet Device */ 12286f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9E01), 12296f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12306f41d12bSSteve Glendinning }, 12316f41d12bSSteve Glendinning { 1232726474b8SSteve Glendinning /* SMSC9512/9514 USB Hub & Ethernet Device */ 1233726474b8SSteve Glendinning USB_DEVICE(0x0424, 0xec00), 1234726474b8SSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 1235726474b8SSteve Glendinning }, 12366f41d12bSSteve Glendinning { 12376f41d12bSSteve Glendinning /* SMSC9500 USB Ethernet Device (SAL10) */ 12386f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9900), 12396f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12406f41d12bSSteve Glendinning }, 12416f41d12bSSteve Glendinning { 12426f41d12bSSteve Glendinning /* SMSC9505 USB Ethernet Device (SAL10) */ 12436f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9901), 12446f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12456f41d12bSSteve Glendinning }, 12466f41d12bSSteve Glendinning { 12476f41d12bSSteve Glendinning /* SMSC9500A USB Ethernet Device (SAL10) */ 12486f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9902), 12496f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12506f41d12bSSteve Glendinning }, 12516f41d12bSSteve Glendinning { 12526f41d12bSSteve Glendinning /* SMSC9505A USB Ethernet Device (SAL10) */ 12536f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9903), 12546f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12556f41d12bSSteve Glendinning }, 12566f41d12bSSteve Glendinning { 12576f41d12bSSteve Glendinning /* SMSC9512/9514 USB Hub & Ethernet Device (SAL10) */ 12586f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9904), 12596f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12606f41d12bSSteve Glendinning }, 12616f41d12bSSteve Glendinning { 12626f41d12bSSteve Glendinning /* SMSC9500A USB Ethernet Device (HAL) */ 12636f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9905), 12646f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12656f41d12bSSteve Glendinning }, 12666f41d12bSSteve Glendinning { 12676f41d12bSSteve Glendinning /* SMSC9505A USB Ethernet Device (HAL) */ 12686f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9906), 12696f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12706f41d12bSSteve Glendinning }, 12716f41d12bSSteve Glendinning { 12726f41d12bSSteve Glendinning /* SMSC9500 USB Ethernet Device (Alternate ID) */ 12736f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9907), 12746f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12756f41d12bSSteve Glendinning }, 12766f41d12bSSteve Glendinning { 12776f41d12bSSteve Glendinning /* SMSC9500A USB Ethernet Device (Alternate ID) */ 12786f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9908), 12796f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12806f41d12bSSteve Glendinning }, 12816f41d12bSSteve Glendinning { 12826f41d12bSSteve Glendinning /* SMSC9512/9514 USB Hub & Ethernet Device (Alternate ID) */ 12836f41d12bSSteve Glendinning USB_DEVICE(0x0424, 0x9909), 12846f41d12bSSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 12856f41d12bSSteve Glendinning }, 128688edaa41SSteve Glendinning { 128788edaa41SSteve Glendinning /* SMSC LAN9530 USB Ethernet Device */ 128888edaa41SSteve Glendinning USB_DEVICE(0x0424, 0x9530), 128988edaa41SSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 129088edaa41SSteve Glendinning }, 129188edaa41SSteve Glendinning { 129288edaa41SSteve Glendinning /* SMSC LAN9730 USB Ethernet Device */ 129388edaa41SSteve Glendinning USB_DEVICE(0x0424, 0x9730), 129488edaa41SSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 129588edaa41SSteve Glendinning }, 129688edaa41SSteve Glendinning { 129788edaa41SSteve Glendinning /* SMSC LAN89530 USB Ethernet Device */ 129888edaa41SSteve Glendinning USB_DEVICE(0x0424, 0x9E08), 129988edaa41SSteve Glendinning .driver_info = (unsigned long) &smsc95xx_info, 130088edaa41SSteve Glendinning }, 13012f7ca802SSteve Glendinning { }, /* END */ 13022f7ca802SSteve Glendinning }; 13032f7ca802SSteve Glendinning MODULE_DEVICE_TABLE(usb, products); 13042f7ca802SSteve Glendinning 13052f7ca802SSteve Glendinning static struct usb_driver smsc95xx_driver = { 13062f7ca802SSteve Glendinning .name = "smsc95xx", 13072f7ca802SSteve Glendinning .id_table = products, 13082f7ca802SSteve Glendinning .probe = usbnet_probe, 1309*b5a04475SSteve Glendinning .suspend = smsc95xx_suspend, 13102f7ca802SSteve Glendinning .resume = usbnet_resume, 1311c954679cSSteve Glendinning .reset_resume = usbnet_resume, 13122f7ca802SSteve Glendinning .disconnect = usbnet_disconnect, 1313e1f12eb6SSarah Sharp .disable_hub_initiated_lpm = 1, 13142f7ca802SSteve Glendinning }; 13152f7ca802SSteve Glendinning 1316d632eb1bSGreg Kroah-Hartman module_usb_driver(smsc95xx_driver); 13172f7ca802SSteve Glendinning 13182f7ca802SSteve Glendinning MODULE_AUTHOR("Nancy Lin"); 131990b24cfbSSteve Glendinning MODULE_AUTHOR("Steve Glendinning <steve.glendinning@shawell.net>"); 13202f7ca802SSteve Glendinning MODULE_DESCRIPTION("SMSC95XX USB 2.0 Ethernet Devices"); 13212f7ca802SSteve Glendinning MODULE_LICENSE("GPL"); 1322