15b2fc499SJeff Garzik /* 25b2fc499SJeff Garzik * Copyright (c) 1999-2005 Petko Manolov (petkan@users.sourceforge.net) 35b2fc499SJeff Garzik * 45b2fc499SJeff Garzik * This program is free software; you can redistribute it and/or modify 55b2fc499SJeff Garzik * it under the terms of the GNU General Public License version 2 as 65b2fc499SJeff Garzik * published by the Free Software Foundation. 75b2fc499SJeff Garzik * 85b2fc499SJeff Garzik * ChangeLog: 95b2fc499SJeff Garzik * .... Most of the time spent on reading sources & docs. 105b2fc499SJeff Garzik * v0.2.x First official release for the Linux kernel. 115b2fc499SJeff Garzik * v0.3.0 Beutified and structured, some bugs fixed. 125b2fc499SJeff Garzik * v0.3.x URBifying bulk requests and bugfixing. First relatively 135b2fc499SJeff Garzik * stable release. Still can touch device's registers only 145b2fc499SJeff Garzik * from top-halves. 155b2fc499SJeff Garzik * v0.4.0 Control messages remained unurbified are now URBs. 165b2fc499SJeff Garzik * Now we can touch the HW at any time. 175b2fc499SJeff Garzik * v0.4.9 Control urbs again use process context to wait. Argh... 185b2fc499SJeff Garzik * Some long standing bugs (enable_net_traffic) fixed. 195b2fc499SJeff Garzik * Also nasty trick about resubmiting control urb from 205b2fc499SJeff Garzik * interrupt context used. Please let me know how it 215b2fc499SJeff Garzik * behaves. Pegasus II support added since this version. 225b2fc499SJeff Garzik * TODO: suppressing HCD warnings spewage on disconnect. 235b2fc499SJeff Garzik * v0.4.13 Ethernet address is now set at probe(), not at open() 245b2fc499SJeff Garzik * time as this seems to break dhcpd. 255b2fc499SJeff Garzik * v0.5.0 branch to 2.5.x kernels 265b2fc499SJeff Garzik * v0.5.1 ethtool support added 275b2fc499SJeff Garzik * v0.5.5 rx socket buffers are in a pool and the their allocation 285b2fc499SJeff Garzik * is out of the interrupt routine. 295b2fc499SJeff Garzik */ 305b2fc499SJeff Garzik 315b2fc499SJeff Garzik #include <linux/sched.h> 325b2fc499SJeff Garzik #include <linux/slab.h> 335b2fc499SJeff Garzik #include <linux/init.h> 345b2fc499SJeff Garzik #include <linux/delay.h> 355b2fc499SJeff Garzik #include <linux/netdevice.h> 365b2fc499SJeff Garzik #include <linux/etherdevice.h> 375b2fc499SJeff Garzik #include <linux/ethtool.h> 385b2fc499SJeff Garzik #include <linux/mii.h> 395b2fc499SJeff Garzik #include <linux/usb.h> 405b2fc499SJeff Garzik #include <linux/module.h> 415b2fc499SJeff Garzik #include <asm/byteorder.h> 425b2fc499SJeff Garzik #include <asm/uaccess.h> 435b2fc499SJeff Garzik #include "pegasus.h" 445b2fc499SJeff Garzik 455b2fc499SJeff Garzik /* 465b2fc499SJeff Garzik * Version Information 475b2fc499SJeff Garzik */ 485b2fc499SJeff Garzik #define DRIVER_VERSION "v0.6.14 (2006/09/27)" 495b2fc499SJeff Garzik #define DRIVER_AUTHOR "Petko Manolov <petkan@users.sourceforge.net>" 505b2fc499SJeff Garzik #define DRIVER_DESC "Pegasus/Pegasus II USB Ethernet driver" 515b2fc499SJeff Garzik 525b2fc499SJeff Garzik static const char driver_name[] = "pegasus"; 535b2fc499SJeff Garzik 545b2fc499SJeff Garzik #undef PEGASUS_WRITE_EEPROM 555b2fc499SJeff Garzik #define BMSR_MEDIA (BMSR_10HALF | BMSR_10FULL | BMSR_100HALF | \ 565b2fc499SJeff Garzik BMSR_100FULL | BMSR_ANEGCAPABLE) 575b2fc499SJeff Garzik 58eb939922SRusty Russell static bool loopback; 59eb939922SRusty Russell static bool mii_mode; 605a9dbfe0SNicolas Kaiser static char *devid; 615b2fc499SJeff Garzik 625b2fc499SJeff Garzik static struct usb_eth_dev usb_dev_id[] = { 635b2fc499SJeff Garzik #define PEGASUS_DEV(pn, vid, pid, flags) \ 645b2fc499SJeff Garzik {.name = pn, .vendor = vid, .device = pid, .private = flags}, 65ab854b24SChris Rankin #define PEGASUS_DEV_CLASS(pn, vid, pid, dclass, flags) \ 66ab854b24SChris Rankin PEGASUS_DEV(pn, vid, pid, flags) 675b2fc499SJeff Garzik #include "pegasus.h" 685b2fc499SJeff Garzik #undef PEGASUS_DEV 69ab854b24SChris Rankin #undef PEGASUS_DEV_CLASS 705b2fc499SJeff Garzik {NULL, 0, 0, 0}, 715b2fc499SJeff Garzik {NULL, 0, 0, 0} 725b2fc499SJeff Garzik }; 735b2fc499SJeff Garzik 745b2fc499SJeff Garzik static struct usb_device_id pegasus_ids[] = { 755b2fc499SJeff Garzik #define PEGASUS_DEV(pn, vid, pid, flags) \ 765b2fc499SJeff Garzik {.match_flags = USB_DEVICE_ID_MATCH_DEVICE, .idVendor = vid, .idProduct = pid}, 77ab854b24SChris Rankin /* 78ab854b24SChris Rankin * The Belkin F8T012xx1 bluetooth adaptor has the same vendor and product 79ab854b24SChris Rankin * IDs as the Belkin F5D5050, so we need to teach the pegasus driver to 80ab854b24SChris Rankin * ignore adaptors belonging to the "Wireless" class 0xE0. For this one 81ab854b24SChris Rankin * case anyway, seeing as the pegasus is for "Wired" adaptors. 82ab854b24SChris Rankin */ 83ab854b24SChris Rankin #define PEGASUS_DEV_CLASS(pn, vid, pid, dclass, flags) \ 84ab854b24SChris Rankin {.match_flags = (USB_DEVICE_ID_MATCH_DEVICE | USB_DEVICE_ID_MATCH_DEV_CLASS), \ 85ab854b24SChris Rankin .idVendor = vid, .idProduct = pid, .bDeviceClass = dclass}, 865b2fc499SJeff Garzik #include "pegasus.h" 875b2fc499SJeff Garzik #undef PEGASUS_DEV 88ab854b24SChris Rankin #undef PEGASUS_DEV_CLASS 895b2fc499SJeff Garzik {}, 905b2fc499SJeff Garzik {} 915b2fc499SJeff Garzik }; 925b2fc499SJeff Garzik 935b2fc499SJeff Garzik MODULE_AUTHOR(DRIVER_AUTHOR); 945b2fc499SJeff Garzik MODULE_DESCRIPTION(DRIVER_DESC); 955b2fc499SJeff Garzik MODULE_LICENSE("GPL"); 965b2fc499SJeff Garzik module_param(loopback, bool, 0); 975b2fc499SJeff Garzik module_param(mii_mode, bool, 0); 985b2fc499SJeff Garzik module_param(devid, charp, 0); 995b2fc499SJeff Garzik MODULE_PARM_DESC(loopback, "Enable MAC loopback mode (bit 0)"); 1005b2fc499SJeff Garzik MODULE_PARM_DESC(mii_mode, "Enable HomePNA mode (bit 0),default=MII mode = 0"); 1015b2fc499SJeff Garzik MODULE_PARM_DESC(devid, "The format is: 'DEV_name:VendorID:DeviceID:Flags'"); 1025b2fc499SJeff Garzik 1035b2fc499SJeff Garzik /* use ethtool to change the level for any given device */ 1045b2fc499SJeff Garzik static int msg_level = -1; 1055b2fc499SJeff Garzik module_param(msg_level, int, 0); 1065b2fc499SJeff Garzik MODULE_PARM_DESC(msg_level, "Override default message level"); 1075b2fc499SJeff Garzik 1085b2fc499SJeff Garzik MODULE_DEVICE_TABLE(usb, pegasus_ids); 1098cb89571SOliver Neukum static const struct net_device_ops pegasus_netdev_ops; 1105b2fc499SJeff Garzik 1115b2fc499SJeff Garzik static int update_eth_regs_async(pegasus_t *); 1125b2fc499SJeff Garzik /* Aargh!!! I _really_ hate such tweaks */ 1135b2fc499SJeff Garzik static void ctrl_callback(struct urb *urb) 1145b2fc499SJeff Garzik { 1155b2fc499SJeff Garzik pegasus_t *pegasus = urb->context; 116c94cb314SOliver Neukum int status = urb->status; 1175b2fc499SJeff Garzik 1185b2fc499SJeff Garzik if (!pegasus) 1195b2fc499SJeff Garzik return; 1205b2fc499SJeff Garzik 121c94cb314SOliver Neukum switch (status) { 1225b2fc499SJeff Garzik case 0: 1235b2fc499SJeff Garzik if (pegasus->flags & ETH_REGS_CHANGE) { 1245b2fc499SJeff Garzik pegasus->flags &= ~ETH_REGS_CHANGE; 1255b2fc499SJeff Garzik pegasus->flags |= ETH_REGS_CHANGED; 1265b2fc499SJeff Garzik update_eth_regs_async(pegasus); 1275b2fc499SJeff Garzik return; 1285b2fc499SJeff Garzik } 1295b2fc499SJeff Garzik break; 1305b2fc499SJeff Garzik case -EINPROGRESS: 1315b2fc499SJeff Garzik return; 1325b2fc499SJeff Garzik case -ENOENT: 1335b2fc499SJeff Garzik break; 1345b2fc499SJeff Garzik default: 135a475f603SJoe Perches if (net_ratelimit()) 136a475f603SJoe Perches netif_dbg(pegasus, drv, pegasus->net, 137a475f603SJoe Perches "%s, status %d\n", __func__, status); 138a475f603SJoe Perches break; 1395b2fc499SJeff Garzik } 1405b2fc499SJeff Garzik pegasus->flags &= ~ETH_REGS_CHANGED; 1415b2fc499SJeff Garzik wake_up(&pegasus->ctrl_wait); 1425b2fc499SJeff Garzik } 1435b2fc499SJeff Garzik 1445b2fc499SJeff Garzik static int get_registers(pegasus_t *pegasus, __u16 indx, __u16 size, 1455b2fc499SJeff Garzik void *data) 1465b2fc499SJeff Garzik { 1475b2fc499SJeff Garzik int ret; 1485b2fc499SJeff Garzik char *buffer; 1495b2fc499SJeff Garzik DECLARE_WAITQUEUE(wait, current); 1505b2fc499SJeff Garzik 1515b2fc499SJeff Garzik buffer = kmalloc(size, GFP_KERNEL); 15214f8dc49SJoe Perches if (!buffer) 1535b2fc499SJeff Garzik return -ENOMEM; 15414f8dc49SJoe Perches 1555b2fc499SJeff Garzik add_wait_queue(&pegasus->ctrl_wait, &wait); 1565b2fc499SJeff Garzik set_current_state(TASK_UNINTERRUPTIBLE); 1575b2fc499SJeff Garzik while (pegasus->flags & ETH_REGS_CHANGED) 1585b2fc499SJeff Garzik schedule(); 1595b2fc499SJeff Garzik remove_wait_queue(&pegasus->ctrl_wait, &wait); 1605b2fc499SJeff Garzik set_current_state(TASK_RUNNING); 1615b2fc499SJeff Garzik 1625b2fc499SJeff Garzik pegasus->dr.bRequestType = PEGASUS_REQT_READ; 1635b2fc499SJeff Garzik pegasus->dr.bRequest = PEGASUS_REQ_GET_REGS; 1645b2fc499SJeff Garzik pegasus->dr.wValue = cpu_to_le16(0); 165da2bbdccSHarvey Harrison pegasus->dr.wIndex = cpu_to_le16(indx); 166da2bbdccSHarvey Harrison pegasus->dr.wLength = cpu_to_le16(size); 1675b2fc499SJeff Garzik pegasus->ctrl_urb->transfer_buffer_length = size; 1685b2fc499SJeff Garzik 1695b2fc499SJeff Garzik usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb, 1705b2fc499SJeff Garzik usb_rcvctrlpipe(pegasus->usb, 0), 1715b2fc499SJeff Garzik (char *) &pegasus->dr, 1725b2fc499SJeff Garzik buffer, size, ctrl_callback, pegasus); 1735b2fc499SJeff Garzik 1745b2fc499SJeff Garzik add_wait_queue(&pegasus->ctrl_wait, &wait); 1755b2fc499SJeff Garzik set_current_state(TASK_UNINTERRUPTIBLE); 1765b2fc499SJeff Garzik 1775b2fc499SJeff Garzik /* using ATOMIC, we'd never wake up if we slept */ 1785b2fc499SJeff Garzik if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) { 1795b2fc499SJeff Garzik set_current_state(TASK_RUNNING); 1805b2fc499SJeff Garzik if (ret == -ENODEV) 1815b2fc499SJeff Garzik netif_device_detach(pegasus->net); 182a475f603SJoe Perches if (net_ratelimit()) 183a475f603SJoe Perches netif_err(pegasus, drv, pegasus->net, 184a475f603SJoe Perches "%s, status %d\n", __func__, ret); 1855b2fc499SJeff Garzik goto out; 1865b2fc499SJeff Garzik } 1875b2fc499SJeff Garzik 1885b2fc499SJeff Garzik schedule(); 1895b2fc499SJeff Garzik out: 1905b2fc499SJeff Garzik remove_wait_queue(&pegasus->ctrl_wait, &wait); 1915b2fc499SJeff Garzik memcpy(data, buffer, size); 1925b2fc499SJeff Garzik kfree(buffer); 1935b2fc499SJeff Garzik 1945b2fc499SJeff Garzik return ret; 1955b2fc499SJeff Garzik } 1965b2fc499SJeff Garzik 1975b2fc499SJeff Garzik static int set_registers(pegasus_t *pegasus, __u16 indx, __u16 size, 1985b2fc499SJeff Garzik void *data) 1995b2fc499SJeff Garzik { 2005b2fc499SJeff Garzik int ret; 2015b2fc499SJeff Garzik char *buffer; 2025b2fc499SJeff Garzik DECLARE_WAITQUEUE(wait, current); 2035b2fc499SJeff Garzik 204175c0441SJulia Lawall buffer = kmemdup(data, size, GFP_KERNEL); 2055b2fc499SJeff Garzik if (!buffer) { 206a475f603SJoe Perches netif_warn(pegasus, drv, pegasus->net, 207a475f603SJoe Perches "out of memory in %s\n", __func__); 2085b2fc499SJeff Garzik return -ENOMEM; 2095b2fc499SJeff Garzik } 2105b2fc499SJeff Garzik 2115b2fc499SJeff Garzik add_wait_queue(&pegasus->ctrl_wait, &wait); 2125b2fc499SJeff Garzik set_current_state(TASK_UNINTERRUPTIBLE); 2135b2fc499SJeff Garzik while (pegasus->flags & ETH_REGS_CHANGED) 2145b2fc499SJeff Garzik schedule(); 2155b2fc499SJeff Garzik remove_wait_queue(&pegasus->ctrl_wait, &wait); 2165b2fc499SJeff Garzik set_current_state(TASK_RUNNING); 2175b2fc499SJeff Garzik 2185b2fc499SJeff Garzik pegasus->dr.bRequestType = PEGASUS_REQT_WRITE; 2195b2fc499SJeff Garzik pegasus->dr.bRequest = PEGASUS_REQ_SET_REGS; 2205b2fc499SJeff Garzik pegasus->dr.wValue = cpu_to_le16(0); 221da2bbdccSHarvey Harrison pegasus->dr.wIndex = cpu_to_le16(indx); 222da2bbdccSHarvey Harrison pegasus->dr.wLength = cpu_to_le16(size); 2235b2fc499SJeff Garzik pegasus->ctrl_urb->transfer_buffer_length = size; 2245b2fc499SJeff Garzik 2255b2fc499SJeff Garzik usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb, 2265b2fc499SJeff Garzik usb_sndctrlpipe(pegasus->usb, 0), 2275b2fc499SJeff Garzik (char *) &pegasus->dr, 2285b2fc499SJeff Garzik buffer, size, ctrl_callback, pegasus); 2295b2fc499SJeff Garzik 2305b2fc499SJeff Garzik add_wait_queue(&pegasus->ctrl_wait, &wait); 2315b2fc499SJeff Garzik set_current_state(TASK_UNINTERRUPTIBLE); 2325b2fc499SJeff Garzik 2335b2fc499SJeff Garzik if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) { 2345b2fc499SJeff Garzik if (ret == -ENODEV) 2355b2fc499SJeff Garzik netif_device_detach(pegasus->net); 236a475f603SJoe Perches netif_err(pegasus, drv, pegasus->net, 237a475f603SJoe Perches "%s, status %d\n", __func__, ret); 2385b2fc499SJeff Garzik goto out; 2395b2fc499SJeff Garzik } 2405b2fc499SJeff Garzik 2415b2fc499SJeff Garzik schedule(); 2425b2fc499SJeff Garzik out: 2435b2fc499SJeff Garzik remove_wait_queue(&pegasus->ctrl_wait, &wait); 2445b2fc499SJeff Garzik kfree(buffer); 2455b2fc499SJeff Garzik 2465b2fc499SJeff Garzik return ret; 2475b2fc499SJeff Garzik } 2485b2fc499SJeff Garzik 2495b2fc499SJeff Garzik static int set_register(pegasus_t *pegasus, __u16 indx, __u8 data) 2505b2fc499SJeff Garzik { 2515b2fc499SJeff Garzik int ret; 2525b2fc499SJeff Garzik char *tmp; 2535b2fc499SJeff Garzik DECLARE_WAITQUEUE(wait, current); 2545b2fc499SJeff Garzik 255175c0441SJulia Lawall tmp = kmemdup(&data, 1, GFP_KERNEL); 2565b2fc499SJeff Garzik if (!tmp) { 257a475f603SJoe Perches netif_warn(pegasus, drv, pegasus->net, 258a475f603SJoe Perches "out of memory in %s\n", __func__); 2595b2fc499SJeff Garzik return -ENOMEM; 2605b2fc499SJeff Garzik } 2615b2fc499SJeff Garzik add_wait_queue(&pegasus->ctrl_wait, &wait); 2625b2fc499SJeff Garzik set_current_state(TASK_UNINTERRUPTIBLE); 2635b2fc499SJeff Garzik while (pegasus->flags & ETH_REGS_CHANGED) 2645b2fc499SJeff Garzik schedule(); 2655b2fc499SJeff Garzik remove_wait_queue(&pegasus->ctrl_wait, &wait); 2665b2fc499SJeff Garzik set_current_state(TASK_RUNNING); 2675b2fc499SJeff Garzik 2685b2fc499SJeff Garzik pegasus->dr.bRequestType = PEGASUS_REQT_WRITE; 2695b2fc499SJeff Garzik pegasus->dr.bRequest = PEGASUS_REQ_SET_REG; 2705b2fc499SJeff Garzik pegasus->dr.wValue = cpu_to_le16(data); 271da2bbdccSHarvey Harrison pegasus->dr.wIndex = cpu_to_le16(indx); 2725b2fc499SJeff Garzik pegasus->dr.wLength = cpu_to_le16(1); 2735b2fc499SJeff Garzik pegasus->ctrl_urb->transfer_buffer_length = 1; 2745b2fc499SJeff Garzik 2755b2fc499SJeff Garzik usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb, 2765b2fc499SJeff Garzik usb_sndctrlpipe(pegasus->usb, 0), 2775b2fc499SJeff Garzik (char *) &pegasus->dr, 2785b2fc499SJeff Garzik tmp, 1, ctrl_callback, pegasus); 2795b2fc499SJeff Garzik 2805b2fc499SJeff Garzik add_wait_queue(&pegasus->ctrl_wait, &wait); 2815b2fc499SJeff Garzik set_current_state(TASK_UNINTERRUPTIBLE); 2825b2fc499SJeff Garzik 2835b2fc499SJeff Garzik if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) { 2845b2fc499SJeff Garzik if (ret == -ENODEV) 2855b2fc499SJeff Garzik netif_device_detach(pegasus->net); 286a475f603SJoe Perches if (net_ratelimit()) 287a475f603SJoe Perches netif_err(pegasus, drv, pegasus->net, 288a475f603SJoe Perches "%s, status %d\n", __func__, ret); 2895b2fc499SJeff Garzik goto out; 2905b2fc499SJeff Garzik } 2915b2fc499SJeff Garzik 2925b2fc499SJeff Garzik schedule(); 2935b2fc499SJeff Garzik out: 2945b2fc499SJeff Garzik remove_wait_queue(&pegasus->ctrl_wait, &wait); 2955b2fc499SJeff Garzik kfree(tmp); 2965b2fc499SJeff Garzik 2975b2fc499SJeff Garzik return ret; 2985b2fc499SJeff Garzik } 2995b2fc499SJeff Garzik 3005b2fc499SJeff Garzik static int update_eth_regs_async(pegasus_t *pegasus) 3015b2fc499SJeff Garzik { 3025b2fc499SJeff Garzik int ret; 3035b2fc499SJeff Garzik 3045b2fc499SJeff Garzik pegasus->dr.bRequestType = PEGASUS_REQT_WRITE; 3055b2fc499SJeff Garzik pegasus->dr.bRequest = PEGASUS_REQ_SET_REGS; 306e3453f63SMichael Buesch pegasus->dr.wValue = cpu_to_le16(0); 3075b2fc499SJeff Garzik pegasus->dr.wIndex = cpu_to_le16(EthCtrl0); 3085b2fc499SJeff Garzik pegasus->dr.wLength = cpu_to_le16(3); 3095b2fc499SJeff Garzik pegasus->ctrl_urb->transfer_buffer_length = 3; 3105b2fc499SJeff Garzik 3115b2fc499SJeff Garzik usb_fill_control_urb(pegasus->ctrl_urb, pegasus->usb, 3125b2fc499SJeff Garzik usb_sndctrlpipe(pegasus->usb, 0), 3135b2fc499SJeff Garzik (char *) &pegasus->dr, 3145b2fc499SJeff Garzik pegasus->eth_regs, 3, ctrl_callback, pegasus); 3155b2fc499SJeff Garzik 3165b2fc499SJeff Garzik if ((ret = usb_submit_urb(pegasus->ctrl_urb, GFP_ATOMIC))) { 3175b2fc499SJeff Garzik if (ret == -ENODEV) 3185b2fc499SJeff Garzik netif_device_detach(pegasus->net); 319a475f603SJoe Perches netif_err(pegasus, drv, pegasus->net, 320a475f603SJoe Perches "%s, status %d\n", __func__, ret); 3215b2fc499SJeff Garzik } 3225b2fc499SJeff Garzik 3235b2fc499SJeff Garzik return ret; 3245b2fc499SJeff Garzik } 3255b2fc499SJeff Garzik 3265b2fc499SJeff Garzik /* Returns 0 on success, error on failure */ 3275b2fc499SJeff Garzik static int read_mii_word(pegasus_t *pegasus, __u8 phy, __u8 indx, __u16 *regd) 3285b2fc499SJeff Garzik { 3295b2fc499SJeff Garzik int i; 3305b2fc499SJeff Garzik __u8 data[4] = { phy, 0, 0, indx }; 3315b2fc499SJeff Garzik __le16 regdi; 3325b2fc499SJeff Garzik int ret; 3335b2fc499SJeff Garzik 3345b2fc499SJeff Garzik set_register(pegasus, PhyCtrl, 0); 3355b2fc499SJeff Garzik set_registers(pegasus, PhyAddr, sizeof(data), data); 3365b2fc499SJeff Garzik set_register(pegasus, PhyCtrl, (indx | PHY_READ)); 3375b2fc499SJeff Garzik for (i = 0; i < REG_TIMEOUT; i++) { 3385b2fc499SJeff Garzik ret = get_registers(pegasus, PhyCtrl, 1, data); 3395b2fc499SJeff Garzik if (ret == -ESHUTDOWN) 3405b2fc499SJeff Garzik goto fail; 3415b2fc499SJeff Garzik if (data[0] & PHY_DONE) 3425b2fc499SJeff Garzik break; 3435b2fc499SJeff Garzik } 344a475f603SJoe Perches 345a475f603SJoe Perches if (i >= REG_TIMEOUT) 346a475f603SJoe Perches goto fail; 347a475f603SJoe Perches 3485b2fc499SJeff Garzik ret = get_registers(pegasus, PhyData, 2, ®di); 3495b2fc499SJeff Garzik *regd = le16_to_cpu(regdi); 3505b2fc499SJeff Garzik return ret; 351a475f603SJoe Perches 3525b2fc499SJeff Garzik fail: 353a475f603SJoe Perches netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__); 3545b2fc499SJeff Garzik 3555b2fc499SJeff Garzik return ret; 3565b2fc499SJeff Garzik } 3575b2fc499SJeff Garzik 3585b2fc499SJeff Garzik static int mdio_read(struct net_device *dev, int phy_id, int loc) 3595b2fc499SJeff Garzik { 3608739cfefSJoe Perches pegasus_t *pegasus = netdev_priv(dev); 3615b2fc499SJeff Garzik u16 res; 3625b2fc499SJeff Garzik 3635b2fc499SJeff Garzik read_mii_word(pegasus, phy_id, loc, &res); 3645b2fc499SJeff Garzik return (int)res; 3655b2fc499SJeff Garzik } 3665b2fc499SJeff Garzik 3675b2fc499SJeff Garzik static int write_mii_word(pegasus_t *pegasus, __u8 phy, __u8 indx, __u16 regd) 3685b2fc499SJeff Garzik { 3695b2fc499SJeff Garzik int i; 3705b2fc499SJeff Garzik __u8 data[4] = { phy, 0, 0, indx }; 3715b2fc499SJeff Garzik int ret; 3725b2fc499SJeff Garzik 3735b2fc499SJeff Garzik data[1] = (u8) regd; 3745b2fc499SJeff Garzik data[2] = (u8) (regd >> 8); 3755b2fc499SJeff Garzik set_register(pegasus, PhyCtrl, 0); 3765b2fc499SJeff Garzik set_registers(pegasus, PhyAddr, sizeof(data), data); 3775b2fc499SJeff Garzik set_register(pegasus, PhyCtrl, (indx | PHY_WRITE)); 3785b2fc499SJeff Garzik for (i = 0; i < REG_TIMEOUT; i++) { 3795b2fc499SJeff Garzik ret = get_registers(pegasus, PhyCtrl, 1, data); 3805b2fc499SJeff Garzik if (ret == -ESHUTDOWN) 3815b2fc499SJeff Garzik goto fail; 3825b2fc499SJeff Garzik if (data[0] & PHY_DONE) 3835b2fc499SJeff Garzik break; 3845b2fc499SJeff Garzik } 385a475f603SJoe Perches 386a475f603SJoe Perches if (i >= REG_TIMEOUT) 387a475f603SJoe Perches goto fail; 388a475f603SJoe Perches 3895b2fc499SJeff Garzik return ret; 3905b2fc499SJeff Garzik 3915b2fc499SJeff Garzik fail: 392a475f603SJoe Perches netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__); 3935b2fc499SJeff Garzik return -ETIMEDOUT; 3945b2fc499SJeff Garzik } 3955b2fc499SJeff Garzik 3965b2fc499SJeff Garzik static void mdio_write(struct net_device *dev, int phy_id, int loc, int val) 3975b2fc499SJeff Garzik { 3988739cfefSJoe Perches pegasus_t *pegasus = netdev_priv(dev); 3995b2fc499SJeff Garzik 4005b2fc499SJeff Garzik write_mii_word(pegasus, phy_id, loc, val); 4015b2fc499SJeff Garzik } 4025b2fc499SJeff Garzik 4035b2fc499SJeff Garzik static int read_eprom_word(pegasus_t *pegasus, __u8 index, __u16 *retdata) 4045b2fc499SJeff Garzik { 4055b2fc499SJeff Garzik int i; 4065b2fc499SJeff Garzik __u8 tmp; 4075b2fc499SJeff Garzik __le16 retdatai; 4085b2fc499SJeff Garzik int ret; 4095b2fc499SJeff Garzik 4105b2fc499SJeff Garzik set_register(pegasus, EpromCtrl, 0); 4115b2fc499SJeff Garzik set_register(pegasus, EpromOffset, index); 4125b2fc499SJeff Garzik set_register(pegasus, EpromCtrl, EPROM_READ); 4135b2fc499SJeff Garzik 4145b2fc499SJeff Garzik for (i = 0; i < REG_TIMEOUT; i++) { 4155b2fc499SJeff Garzik ret = get_registers(pegasus, EpromCtrl, 1, &tmp); 4165b2fc499SJeff Garzik if (tmp & EPROM_DONE) 4175b2fc499SJeff Garzik break; 4185b2fc499SJeff Garzik if (ret == -ESHUTDOWN) 4195b2fc499SJeff Garzik goto fail; 4205b2fc499SJeff Garzik } 421a475f603SJoe Perches if (i >= REG_TIMEOUT) 422a475f603SJoe Perches goto fail; 423a475f603SJoe Perches 4245b2fc499SJeff Garzik ret = get_registers(pegasus, EpromData, 2, &retdatai); 4255b2fc499SJeff Garzik *retdata = le16_to_cpu(retdatai); 4265b2fc499SJeff Garzik return ret; 4275b2fc499SJeff Garzik 4285b2fc499SJeff Garzik fail: 429a475f603SJoe Perches netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__); 4305b2fc499SJeff Garzik return -ETIMEDOUT; 4315b2fc499SJeff Garzik } 4325b2fc499SJeff Garzik 4335b2fc499SJeff Garzik #ifdef PEGASUS_WRITE_EEPROM 4345b2fc499SJeff Garzik static inline void enable_eprom_write(pegasus_t *pegasus) 4355b2fc499SJeff Garzik { 4365b2fc499SJeff Garzik __u8 tmp; 4375b2fc499SJeff Garzik int ret; 4385b2fc499SJeff Garzik 4395b2fc499SJeff Garzik get_registers(pegasus, EthCtrl2, 1, &tmp); 4405b2fc499SJeff Garzik set_register(pegasus, EthCtrl2, tmp | EPROM_WR_ENABLE); 4415b2fc499SJeff Garzik } 4425b2fc499SJeff Garzik 4435b2fc499SJeff Garzik static inline void disable_eprom_write(pegasus_t *pegasus) 4445b2fc499SJeff Garzik { 4455b2fc499SJeff Garzik __u8 tmp; 4465b2fc499SJeff Garzik int ret; 4475b2fc499SJeff Garzik 4485b2fc499SJeff Garzik get_registers(pegasus, EthCtrl2, 1, &tmp); 4495b2fc499SJeff Garzik set_register(pegasus, EpromCtrl, 0); 4505b2fc499SJeff Garzik set_register(pegasus, EthCtrl2, tmp & ~EPROM_WR_ENABLE); 4515b2fc499SJeff Garzik } 4525b2fc499SJeff Garzik 4535b2fc499SJeff Garzik static int write_eprom_word(pegasus_t *pegasus, __u8 index, __u16 data) 4545b2fc499SJeff Garzik { 4555b2fc499SJeff Garzik int i; 4565b2fc499SJeff Garzik __u8 tmp, d[4] = { 0x3f, 0, 0, EPROM_WRITE }; 4575b2fc499SJeff Garzik int ret; 458e3453f63SMichael Buesch __le16 le_data = cpu_to_le16(data); 4595b2fc499SJeff Garzik 4605b2fc499SJeff Garzik set_registers(pegasus, EpromOffset, 4, d); 4615b2fc499SJeff Garzik enable_eprom_write(pegasus); 4625b2fc499SJeff Garzik set_register(pegasus, EpromOffset, index); 463e3453f63SMichael Buesch set_registers(pegasus, EpromData, 2, &le_data); 4645b2fc499SJeff Garzik set_register(pegasus, EpromCtrl, EPROM_WRITE); 4655b2fc499SJeff Garzik 4665b2fc499SJeff Garzik for (i = 0; i < REG_TIMEOUT; i++) { 4675b2fc499SJeff Garzik ret = get_registers(pegasus, EpromCtrl, 1, &tmp); 4685b2fc499SJeff Garzik if (ret == -ESHUTDOWN) 4695b2fc499SJeff Garzik goto fail; 4705b2fc499SJeff Garzik if (tmp & EPROM_DONE) 4715b2fc499SJeff Garzik break; 4725b2fc499SJeff Garzik } 4735b2fc499SJeff Garzik disable_eprom_write(pegasus); 474a475f603SJoe Perches if (i >= REG_TIMEOUT) 475a475f603SJoe Perches goto fail; 476a475f603SJoe Perches 4775b2fc499SJeff Garzik return ret; 478a475f603SJoe Perches 4795b2fc499SJeff Garzik fail: 480a475f603SJoe Perches netif_warn(pegasus, drv, pegasus->net, "%s failed\n", __func__); 4815b2fc499SJeff Garzik return -ETIMEDOUT; 4825b2fc499SJeff Garzik } 4835b2fc499SJeff Garzik #endif /* PEGASUS_WRITE_EEPROM */ 4845b2fc499SJeff Garzik 4855b2fc499SJeff Garzik static inline void get_node_id(pegasus_t *pegasus, __u8 *id) 4865b2fc499SJeff Garzik { 4875b2fc499SJeff Garzik int i; 4885b2fc499SJeff Garzik __u16 w16; 4895b2fc499SJeff Garzik 4905b2fc499SJeff Garzik for (i = 0; i < 3; i++) { 4915b2fc499SJeff Garzik read_eprom_word(pegasus, i, &w16); 492da2bbdccSHarvey Harrison ((__le16 *) id)[i] = cpu_to_le16(w16); 4935b2fc499SJeff Garzik } 4945b2fc499SJeff Garzik } 4955b2fc499SJeff Garzik 4965b2fc499SJeff Garzik static void set_ethernet_addr(pegasus_t *pegasus) 4975b2fc499SJeff Garzik { 4985b2fc499SJeff Garzik __u8 node_id[6]; 4995b2fc499SJeff Garzik 5005b2fc499SJeff Garzik if (pegasus->features & PEGASUS_II) { 5015b2fc499SJeff Garzik get_registers(pegasus, 0x10, sizeof(node_id), node_id); 5025b2fc499SJeff Garzik } else { 5035b2fc499SJeff Garzik get_node_id(pegasus, node_id); 5045b2fc499SJeff Garzik set_registers(pegasus, EthID, sizeof(node_id), node_id); 5055b2fc499SJeff Garzik } 5065b2fc499SJeff Garzik memcpy(pegasus->net->dev_addr, node_id, sizeof(node_id)); 5075b2fc499SJeff Garzik } 5085b2fc499SJeff Garzik 5095b2fc499SJeff Garzik static inline int reset_mac(pegasus_t *pegasus) 5105b2fc499SJeff Garzik { 5115b2fc499SJeff Garzik __u8 data = 0x8; 5125b2fc499SJeff Garzik int i; 5135b2fc499SJeff Garzik 5145b2fc499SJeff Garzik set_register(pegasus, EthCtrl1, data); 5155b2fc499SJeff Garzik for (i = 0; i < REG_TIMEOUT; i++) { 5165b2fc499SJeff Garzik get_registers(pegasus, EthCtrl1, 1, &data); 5175b2fc499SJeff Garzik if (~data & 0x08) { 518681f1623SDan Carpenter if (loopback) 5195b2fc499SJeff Garzik break; 5205b2fc499SJeff Garzik if (mii_mode && (pegasus->features & HAS_HOME_PNA)) 5215b2fc499SJeff Garzik set_register(pegasus, Gpio1, 0x34); 5225b2fc499SJeff Garzik else 5235b2fc499SJeff Garzik set_register(pegasus, Gpio1, 0x26); 5245b2fc499SJeff Garzik set_register(pegasus, Gpio0, pegasus->features); 5255b2fc499SJeff Garzik set_register(pegasus, Gpio0, DEFAULT_GPIO_SET); 5265b2fc499SJeff Garzik break; 5275b2fc499SJeff Garzik } 5285b2fc499SJeff Garzik } 5295b2fc499SJeff Garzik if (i == REG_TIMEOUT) 5305b2fc499SJeff Garzik return -ETIMEDOUT; 5315b2fc499SJeff Garzik 5325b2fc499SJeff Garzik if (usb_dev_id[pegasus->dev_index].vendor == VENDOR_LINKSYS || 5335b2fc499SJeff Garzik usb_dev_id[pegasus->dev_index].vendor == VENDOR_DLINK) { 5345b2fc499SJeff Garzik set_register(pegasus, Gpio0, 0x24); 5355b2fc499SJeff Garzik set_register(pegasus, Gpio0, 0x26); 5365b2fc499SJeff Garzik } 5375b2fc499SJeff Garzik if (usb_dev_id[pegasus->dev_index].vendor == VENDOR_ELCON) { 5385b2fc499SJeff Garzik __u16 auxmode; 5395b2fc499SJeff Garzik read_mii_word(pegasus, 3, 0x1b, &auxmode); 5405b2fc499SJeff Garzik write_mii_word(pegasus, 3, 0x1b, auxmode | 4); 5415b2fc499SJeff Garzik } 5425b2fc499SJeff Garzik 5435b2fc499SJeff Garzik return 0; 5445b2fc499SJeff Garzik } 5455b2fc499SJeff Garzik 5465b2fc499SJeff Garzik static int enable_net_traffic(struct net_device *dev, struct usb_device *usb) 5475b2fc499SJeff Garzik { 5485b2fc499SJeff Garzik __u16 linkpart; 5495b2fc499SJeff Garzik __u8 data[4]; 5505b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 5515b2fc499SJeff Garzik int ret; 5525b2fc499SJeff Garzik 5535b2fc499SJeff Garzik read_mii_word(pegasus, pegasus->phy, MII_LPA, &linkpart); 5545b2fc499SJeff Garzik data[0] = 0xc9; 5555b2fc499SJeff Garzik data[1] = 0; 5565b2fc499SJeff Garzik if (linkpart & (ADVERTISE_100FULL | ADVERTISE_10FULL)) 5575b2fc499SJeff Garzik data[1] |= 0x20; /* set full duplex */ 5585b2fc499SJeff Garzik if (linkpart & (ADVERTISE_100FULL | ADVERTISE_100HALF)) 5595b2fc499SJeff Garzik data[1] |= 0x10; /* set 100 Mbps */ 5605b2fc499SJeff Garzik if (mii_mode) 5615b2fc499SJeff Garzik data[1] = 0; 562681f1623SDan Carpenter data[2] = loopback ? 0x09 : 0x01; 5635b2fc499SJeff Garzik 5645b2fc499SJeff Garzik memcpy(pegasus->eth_regs, data, sizeof(data)); 5655b2fc499SJeff Garzik ret = set_registers(pegasus, EthCtrl0, 3, data); 5665b2fc499SJeff Garzik 5675b2fc499SJeff Garzik if (usb_dev_id[pegasus->dev_index].vendor == VENDOR_LINKSYS || 5685b2fc499SJeff Garzik usb_dev_id[pegasus->dev_index].vendor == VENDOR_LINKSYS2 || 5695b2fc499SJeff Garzik usb_dev_id[pegasus->dev_index].vendor == VENDOR_DLINK) { 5705b2fc499SJeff Garzik u16 auxmode; 5715b2fc499SJeff Garzik read_mii_word(pegasus, 0, 0x1b, &auxmode); 5725b2fc499SJeff Garzik write_mii_word(pegasus, 0, 0x1b, auxmode | 4); 5735b2fc499SJeff Garzik } 5745b2fc499SJeff Garzik 5755b2fc499SJeff Garzik return ret; 5765b2fc499SJeff Garzik } 5775b2fc499SJeff Garzik 5785b2fc499SJeff Garzik static void read_bulk_callback(struct urb *urb) 5795b2fc499SJeff Garzik { 5805b2fc499SJeff Garzik pegasus_t *pegasus = urb->context; 5815b2fc499SJeff Garzik struct net_device *net; 5825b2fc499SJeff Garzik int rx_status, count = urb->actual_length; 583c94cb314SOliver Neukum int status = urb->status; 5845b2fc499SJeff Garzik u8 *buf = urb->transfer_buffer; 5855b2fc499SJeff Garzik __u16 pkt_len; 5865b2fc499SJeff Garzik 5875b2fc499SJeff Garzik if (!pegasus) 5885b2fc499SJeff Garzik return; 5895b2fc499SJeff Garzik 5905b2fc499SJeff Garzik net = pegasus->net; 5915b2fc499SJeff Garzik if (!netif_device_present(net) || !netif_running(net)) 5925b2fc499SJeff Garzik return; 5935b2fc499SJeff Garzik 594c94cb314SOliver Neukum switch (status) { 5955b2fc499SJeff Garzik case 0: 5965b2fc499SJeff Garzik break; 5975b2fc499SJeff Garzik case -ETIME: 598a475f603SJoe Perches netif_dbg(pegasus, rx_err, net, "reset MAC\n"); 5995b2fc499SJeff Garzik pegasus->flags &= ~PEGASUS_RX_BUSY; 6005b2fc499SJeff Garzik break; 6015b2fc499SJeff Garzik case -EPIPE: /* stall, or disconnect from TT */ 6025b2fc499SJeff Garzik /* FIXME schedule work to clear the halt */ 603a475f603SJoe Perches netif_warn(pegasus, rx_err, net, "no rx stall recovery\n"); 6045b2fc499SJeff Garzik return; 6055b2fc499SJeff Garzik case -ENOENT: 6065b2fc499SJeff Garzik case -ECONNRESET: 6075b2fc499SJeff Garzik case -ESHUTDOWN: 608a475f603SJoe Perches netif_dbg(pegasus, ifdown, net, "rx unlink, %d\n", status); 6095b2fc499SJeff Garzik return; 6105b2fc499SJeff Garzik default: 611a475f603SJoe Perches netif_dbg(pegasus, rx_err, net, "RX status %d\n", status); 6125b2fc499SJeff Garzik goto goon; 6135b2fc499SJeff Garzik } 6145b2fc499SJeff Garzik 6155b2fc499SJeff Garzik if (!count || count < 4) 6165b2fc499SJeff Garzik goto goon; 6175b2fc499SJeff Garzik 6185b2fc499SJeff Garzik rx_status = buf[count - 2]; 6195b2fc499SJeff Garzik if (rx_status & 0x1e) { 620a475f603SJoe Perches netif_dbg(pegasus, rx_err, net, 621a475f603SJoe Perches "RX packet error %x\n", rx_status); 6225b2fc499SJeff Garzik pegasus->stats.rx_errors++; 6235a9dbfe0SNicolas Kaiser if (rx_status & 0x06) /* long or runt */ 6245b2fc499SJeff Garzik pegasus->stats.rx_length_errors++; 6255b2fc499SJeff Garzik if (rx_status & 0x08) 6265b2fc499SJeff Garzik pegasus->stats.rx_crc_errors++; 6275a9dbfe0SNicolas Kaiser if (rx_status & 0x10) /* extra bits */ 6285b2fc499SJeff Garzik pegasus->stats.rx_frame_errors++; 6295b2fc499SJeff Garzik goto goon; 6305b2fc499SJeff Garzik } 6315b2fc499SJeff Garzik if (pegasus->chip == 0x8513) { 6325b2fc499SJeff Garzik pkt_len = le32_to_cpu(*(__le32 *)urb->transfer_buffer); 6335b2fc499SJeff Garzik pkt_len &= 0x0fff; 6345b2fc499SJeff Garzik pegasus->rx_skb->data += 2; 6355b2fc499SJeff Garzik } else { 6365b2fc499SJeff Garzik pkt_len = buf[count - 3] << 8; 6375b2fc499SJeff Garzik pkt_len += buf[count - 4]; 6385b2fc499SJeff Garzik pkt_len &= 0xfff; 6395b2fc499SJeff Garzik pkt_len -= 8; 6405b2fc499SJeff Garzik } 6415b2fc499SJeff Garzik 6425b2fc499SJeff Garzik /* 6435b2fc499SJeff Garzik * If the packet is unreasonably long, quietly drop it rather than 6445b2fc499SJeff Garzik * kernel panicing by calling skb_put. 6455b2fc499SJeff Garzik */ 6465b2fc499SJeff Garzik if (pkt_len > PEGASUS_MTU) 6475b2fc499SJeff Garzik goto goon; 6485b2fc499SJeff Garzik 6495b2fc499SJeff Garzik /* 6505b2fc499SJeff Garzik * at this point we are sure pegasus->rx_skb != NULL 6515b2fc499SJeff Garzik * so we go ahead and pass up the packet. 6525b2fc499SJeff Garzik */ 6535b2fc499SJeff Garzik skb_put(pegasus->rx_skb, pkt_len); 6545b2fc499SJeff Garzik pegasus->rx_skb->protocol = eth_type_trans(pegasus->rx_skb, net); 6555b2fc499SJeff Garzik netif_rx(pegasus->rx_skb); 6565b2fc499SJeff Garzik pegasus->stats.rx_packets++; 6575b2fc499SJeff Garzik pegasus->stats.rx_bytes += pkt_len; 6585b2fc499SJeff Garzik 6595b2fc499SJeff Garzik if (pegasus->flags & PEGASUS_UNPLUG) 6605b2fc499SJeff Garzik return; 6615b2fc499SJeff Garzik 662*313a58e4SPetko Manolov pegasus->rx_skb = __netdev_alloc_skb_ip_align(pegasus->net, PEGASUS_MTU, 663*313a58e4SPetko Manolov GFP_ATOMIC); 6645b2fc499SJeff Garzik 6655b2fc499SJeff Garzik if (pegasus->rx_skb == NULL) 6665b2fc499SJeff Garzik goto tl_sched; 6675b2fc499SJeff Garzik goon: 6685b2fc499SJeff Garzik usb_fill_bulk_urb(pegasus->rx_urb, pegasus->usb, 6695b2fc499SJeff Garzik usb_rcvbulkpipe(pegasus->usb, 1), 6705b2fc499SJeff Garzik pegasus->rx_skb->data, PEGASUS_MTU + 8, 6715b2fc499SJeff Garzik read_bulk_callback, pegasus); 6725b2fc499SJeff Garzik rx_status = usb_submit_urb(pegasus->rx_urb, GFP_ATOMIC); 6735b2fc499SJeff Garzik if (rx_status == -ENODEV) 6745b2fc499SJeff Garzik netif_device_detach(pegasus->net); 6755b2fc499SJeff Garzik else if (rx_status) { 6765b2fc499SJeff Garzik pegasus->flags |= PEGASUS_RX_URB_FAIL; 6775b2fc499SJeff Garzik goto tl_sched; 6785b2fc499SJeff Garzik } else { 6795b2fc499SJeff Garzik pegasus->flags &= ~PEGASUS_RX_URB_FAIL; 6805b2fc499SJeff Garzik } 6815b2fc499SJeff Garzik 6825b2fc499SJeff Garzik return; 6835b2fc499SJeff Garzik 6845b2fc499SJeff Garzik tl_sched: 6855b2fc499SJeff Garzik tasklet_schedule(&pegasus->rx_tl); 6865b2fc499SJeff Garzik } 6875b2fc499SJeff Garzik 6885b2fc499SJeff Garzik static void rx_fixup(unsigned long data) 6895b2fc499SJeff Garzik { 6905b2fc499SJeff Garzik pegasus_t *pegasus; 6915b2fc499SJeff Garzik int status; 6925b2fc499SJeff Garzik 6935b2fc499SJeff Garzik pegasus = (pegasus_t *) data; 6945b2fc499SJeff Garzik if (pegasus->flags & PEGASUS_UNPLUG) 6955b2fc499SJeff Garzik return; 6965b2fc499SJeff Garzik 6975b2fc499SJeff Garzik if (pegasus->flags & PEGASUS_RX_URB_FAIL) 6985b2fc499SJeff Garzik if (pegasus->rx_skb) 6995b2fc499SJeff Garzik goto try_again; 7005a9dbfe0SNicolas Kaiser if (pegasus->rx_skb == NULL) 701*313a58e4SPetko Manolov pegasus->rx_skb = __netdev_alloc_skb_ip_align(pegasus->net, 702*313a58e4SPetko Manolov PEGASUS_MTU, 703*313a58e4SPetko Manolov GFP_ATOMIC); 7045b2fc499SJeff Garzik if (pegasus->rx_skb == NULL) { 705a475f603SJoe Perches netif_warn(pegasus, rx_err, pegasus->net, "low on memory\n"); 7065b2fc499SJeff Garzik tasklet_schedule(&pegasus->rx_tl); 707*313a58e4SPetko Manolov return; 7085b2fc499SJeff Garzik } 7095b2fc499SJeff Garzik usb_fill_bulk_urb(pegasus->rx_urb, pegasus->usb, 7105b2fc499SJeff Garzik usb_rcvbulkpipe(pegasus->usb, 1), 7115b2fc499SJeff Garzik pegasus->rx_skb->data, PEGASUS_MTU + 8, 7125b2fc499SJeff Garzik read_bulk_callback, pegasus); 7135b2fc499SJeff Garzik try_again: 7145b2fc499SJeff Garzik status = usb_submit_urb(pegasus->rx_urb, GFP_ATOMIC); 7155b2fc499SJeff Garzik if (status == -ENODEV) 7165b2fc499SJeff Garzik netif_device_detach(pegasus->net); 7175b2fc499SJeff Garzik else if (status) { 7185b2fc499SJeff Garzik pegasus->flags |= PEGASUS_RX_URB_FAIL; 7195b2fc499SJeff Garzik tasklet_schedule(&pegasus->rx_tl); 7205b2fc499SJeff Garzik } else { 7215b2fc499SJeff Garzik pegasus->flags &= ~PEGASUS_RX_URB_FAIL; 7225b2fc499SJeff Garzik } 7235b2fc499SJeff Garzik } 7245b2fc499SJeff Garzik 7255b2fc499SJeff Garzik static void write_bulk_callback(struct urb *urb) 7265b2fc499SJeff Garzik { 7275b2fc499SJeff Garzik pegasus_t *pegasus = urb->context; 7289351982bSMicah Gruber struct net_device *net; 729c94cb314SOliver Neukum int status = urb->status; 7305b2fc499SJeff Garzik 7315b2fc499SJeff Garzik if (!pegasus) 7325b2fc499SJeff Garzik return; 7335b2fc499SJeff Garzik 7349351982bSMicah Gruber net = pegasus->net; 7359351982bSMicah Gruber 7365b2fc499SJeff Garzik if (!netif_device_present(net) || !netif_running(net)) 7375b2fc499SJeff Garzik return; 7385b2fc499SJeff Garzik 739c94cb314SOliver Neukum switch (status) { 7405b2fc499SJeff Garzik case -EPIPE: 7415b2fc499SJeff Garzik /* FIXME schedule_work() to clear the tx halt */ 7425b2fc499SJeff Garzik netif_stop_queue(net); 743a475f603SJoe Perches netif_warn(pegasus, tx_err, net, "no tx stall recovery\n"); 7445b2fc499SJeff Garzik return; 7455b2fc499SJeff Garzik case -ENOENT: 7465b2fc499SJeff Garzik case -ECONNRESET: 7475b2fc499SJeff Garzik case -ESHUTDOWN: 748a475f603SJoe Perches netif_dbg(pegasus, ifdown, net, "tx unlink, %d\n", status); 7495b2fc499SJeff Garzik return; 7505b2fc499SJeff Garzik default: 751a475f603SJoe Perches netif_info(pegasus, tx_err, net, "TX status %d\n", status); 7525b2fc499SJeff Garzik /* FALL THROUGH */ 7535b2fc499SJeff Garzik case 0: 7545b2fc499SJeff Garzik break; 7555b2fc499SJeff Garzik } 7565b2fc499SJeff Garzik 7571ae5dc34SEric Dumazet net->trans_start = jiffies; /* prevent tx timeout */ 7585b2fc499SJeff Garzik netif_wake_queue(net); 7595b2fc499SJeff Garzik } 7605b2fc499SJeff Garzik 7615b2fc499SJeff Garzik static void intr_callback(struct urb *urb) 7625b2fc499SJeff Garzik { 7635b2fc499SJeff Garzik pegasus_t *pegasus = urb->context; 7645b2fc499SJeff Garzik struct net_device *net; 765c94cb314SOliver Neukum int res, status = urb->status; 7665b2fc499SJeff Garzik 7675b2fc499SJeff Garzik if (!pegasus) 7685b2fc499SJeff Garzik return; 7695b2fc499SJeff Garzik net = pegasus->net; 7705b2fc499SJeff Garzik 771c94cb314SOliver Neukum switch (status) { 7725b2fc499SJeff Garzik case 0: 7735b2fc499SJeff Garzik break; 7745b2fc499SJeff Garzik case -ECONNRESET: /* unlink */ 7755b2fc499SJeff Garzik case -ENOENT: 7765b2fc499SJeff Garzik case -ESHUTDOWN: 7775b2fc499SJeff Garzik return; 7785b2fc499SJeff Garzik default: 7795b2fc499SJeff Garzik /* some Pegasus-I products report LOTS of data 7805b2fc499SJeff Garzik * toggle errors... avoid log spamming 7815b2fc499SJeff Garzik */ 782a475f603SJoe Perches netif_dbg(pegasus, timer, net, "intr status %d\n", status); 7835b2fc499SJeff Garzik } 7845b2fc499SJeff Garzik 7855b2fc499SJeff Garzik if (urb->actual_length >= 6) { 7865b2fc499SJeff Garzik u8 *d = urb->transfer_buffer; 7875b2fc499SJeff Garzik 7885b2fc499SJeff Garzik /* byte 0 == tx_status1, reg 2B */ 7895b2fc499SJeff Garzik if (d[0] & (TX_UNDERRUN|EXCESSIVE_COL 7905b2fc499SJeff Garzik |LATE_COL|JABBER_TIMEOUT)) { 7915b2fc499SJeff Garzik pegasus->stats.tx_errors++; 7925b2fc499SJeff Garzik if (d[0] & TX_UNDERRUN) 7935b2fc499SJeff Garzik pegasus->stats.tx_fifo_errors++; 7945b2fc499SJeff Garzik if (d[0] & (EXCESSIVE_COL | JABBER_TIMEOUT)) 7955b2fc499SJeff Garzik pegasus->stats.tx_aborted_errors++; 7965b2fc499SJeff Garzik if (d[0] & LATE_COL) 7975b2fc499SJeff Garzik pegasus->stats.tx_window_errors++; 7985b2fc499SJeff Garzik } 7995b2fc499SJeff Garzik 8005b2fc499SJeff Garzik /* d[5].LINK_STATUS lies on some adapters. 8015b2fc499SJeff Garzik * d[0].NO_CARRIER kicks in only with failed TX. 8025b2fc499SJeff Garzik * ... so monitoring with MII may be safest. 8035b2fc499SJeff Garzik */ 8045b2fc499SJeff Garzik 8055b2fc499SJeff Garzik /* bytes 3-4 == rx_lostpkt, reg 2E/2F */ 8065b2fc499SJeff Garzik pegasus->stats.rx_missed_errors += ((d[3] & 0x7f) << 8) | d[4]; 8075b2fc499SJeff Garzik } 8085b2fc499SJeff Garzik 809c94cb314SOliver Neukum res = usb_submit_urb(urb, GFP_ATOMIC); 810c94cb314SOliver Neukum if (res == -ENODEV) 8115b2fc499SJeff Garzik netif_device_detach(pegasus->net); 812a475f603SJoe Perches if (res) 813a475f603SJoe Perches netif_err(pegasus, timer, net, 814a475f603SJoe Perches "can't resubmit interrupt urb, %d\n", res); 8155b2fc499SJeff Garzik } 8165b2fc499SJeff Garzik 8175b2fc499SJeff Garzik static void pegasus_tx_timeout(struct net_device *net) 8185b2fc499SJeff Garzik { 8195b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 820a475f603SJoe Perches netif_warn(pegasus, timer, net, "tx timeout\n"); 8215b2fc499SJeff Garzik usb_unlink_urb(pegasus->tx_urb); 8225b2fc499SJeff Garzik pegasus->stats.tx_errors++; 8235b2fc499SJeff Garzik } 8245b2fc499SJeff Garzik 82525a79c41SStephen Hemminger static netdev_tx_t pegasus_start_xmit(struct sk_buff *skb, 82625a79c41SStephen Hemminger struct net_device *net) 8275b2fc499SJeff Garzik { 8285b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 8295b2fc499SJeff Garzik int count = ((skb->len + 2) & 0x3f) ? skb->len + 2 : skb->len + 3; 8305b2fc499SJeff Garzik int res; 8315b2fc499SJeff Garzik __u16 l16 = skb->len; 8325b2fc499SJeff Garzik 8335b2fc499SJeff Garzik netif_stop_queue(net); 8345b2fc499SJeff Garzik 8355b2fc499SJeff Garzik ((__le16 *) pegasus->tx_buff)[0] = cpu_to_le16(l16); 8365b2fc499SJeff Garzik skb_copy_from_linear_data(skb, pegasus->tx_buff + 2, skb->len); 8375b2fc499SJeff Garzik usb_fill_bulk_urb(pegasus->tx_urb, pegasus->usb, 8385b2fc499SJeff Garzik usb_sndbulkpipe(pegasus->usb, 2), 8395b2fc499SJeff Garzik pegasus->tx_buff, count, 8405b2fc499SJeff Garzik write_bulk_callback, pegasus); 8415b2fc499SJeff Garzik if ((res = usb_submit_urb(pegasus->tx_urb, GFP_ATOMIC))) { 842a475f603SJoe Perches netif_warn(pegasus, tx_err, net, "fail tx, %d\n", res); 8435b2fc499SJeff Garzik switch (res) { 8445b2fc499SJeff Garzik case -EPIPE: /* stall, or disconnect from TT */ 8455b2fc499SJeff Garzik /* cleanup should already have been scheduled */ 8465b2fc499SJeff Garzik break; 8475b2fc499SJeff Garzik case -ENODEV: /* disconnect() upcoming */ 8489dd014ebSOliver Neukum case -EPERM: 8495b2fc499SJeff Garzik netif_device_detach(pegasus->net); 8505b2fc499SJeff Garzik break; 8515b2fc499SJeff Garzik default: 8525b2fc499SJeff Garzik pegasus->stats.tx_errors++; 8535b2fc499SJeff Garzik netif_start_queue(net); 8545b2fc499SJeff Garzik } 8555b2fc499SJeff Garzik } else { 8565b2fc499SJeff Garzik pegasus->stats.tx_packets++; 8575b2fc499SJeff Garzik pegasus->stats.tx_bytes += skb->len; 8585b2fc499SJeff Garzik } 8595b2fc499SJeff Garzik dev_kfree_skb(skb); 8605b2fc499SJeff Garzik 8616ed10654SPatrick McHardy return NETDEV_TX_OK; 8625b2fc499SJeff Garzik } 8635b2fc499SJeff Garzik 8645b2fc499SJeff Garzik static struct net_device_stats *pegasus_netdev_stats(struct net_device *dev) 8655b2fc499SJeff Garzik { 8665b2fc499SJeff Garzik return &((pegasus_t *) netdev_priv(dev))->stats; 8675b2fc499SJeff Garzik } 8685b2fc499SJeff Garzik 8695b2fc499SJeff Garzik static inline void disable_net_traffic(pegasus_t *pegasus) 8705b2fc499SJeff Garzik { 871e3453f63SMichael Buesch __le16 tmp = cpu_to_le16(0); 8725b2fc499SJeff Garzik 873e3453f63SMichael Buesch set_registers(pegasus, EthCtrl0, sizeof(tmp), &tmp); 8745b2fc499SJeff Garzik } 8755b2fc499SJeff Garzik 8765b2fc499SJeff Garzik static inline void get_interrupt_interval(pegasus_t *pegasus) 8775b2fc499SJeff Garzik { 878e3453f63SMichael Buesch u16 data; 879e3453f63SMichael Buesch u8 interval; 8805b2fc499SJeff Garzik 881e3453f63SMichael Buesch read_eprom_word(pegasus, 4, &data); 882e3453f63SMichael Buesch interval = data >> 8; 8835b2fc499SJeff Garzik if (pegasus->usb->speed != USB_SPEED_HIGH) { 884e3453f63SMichael Buesch if (interval < 0x80) { 885a475f603SJoe Perches netif_info(pegasus, timer, pegasus->net, 886a475f603SJoe Perches "intr interval changed from %ums to %ums\n", 887e3453f63SMichael Buesch interval, 0x80); 888e3453f63SMichael Buesch interval = 0x80; 889e3453f63SMichael Buesch data = (data & 0x00FF) | ((u16)interval << 8); 8905b2fc499SJeff Garzik #ifdef PEGASUS_WRITE_EEPROM 891e3453f63SMichael Buesch write_eprom_word(pegasus, 4, data); 8925b2fc499SJeff Garzik #endif 8935b2fc499SJeff Garzik } 8945b2fc499SJeff Garzik } 895e3453f63SMichael Buesch pegasus->intr_interval = interval; 8965b2fc499SJeff Garzik } 8975b2fc499SJeff Garzik 8985b2fc499SJeff Garzik static void set_carrier(struct net_device *net) 8995b2fc499SJeff Garzik { 9005b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 9015b2fc499SJeff Garzik u16 tmp; 9025b2fc499SJeff Garzik 9035b2fc499SJeff Garzik if (read_mii_word(pegasus, pegasus->phy, MII_BMSR, &tmp)) 9045b2fc499SJeff Garzik return; 9055b2fc499SJeff Garzik 9065b2fc499SJeff Garzik if (tmp & BMSR_LSTATUS) 9075b2fc499SJeff Garzik netif_carrier_on(net); 9085b2fc499SJeff Garzik else 9095b2fc499SJeff Garzik netif_carrier_off(net); 9105b2fc499SJeff Garzik } 9115b2fc499SJeff Garzik 9125b2fc499SJeff Garzik static void free_all_urbs(pegasus_t *pegasus) 9135b2fc499SJeff Garzik { 9145b2fc499SJeff Garzik usb_free_urb(pegasus->intr_urb); 9155b2fc499SJeff Garzik usb_free_urb(pegasus->tx_urb); 9165b2fc499SJeff Garzik usb_free_urb(pegasus->rx_urb); 9175b2fc499SJeff Garzik usb_free_urb(pegasus->ctrl_urb); 9185b2fc499SJeff Garzik } 9195b2fc499SJeff Garzik 9205b2fc499SJeff Garzik static void unlink_all_urbs(pegasus_t *pegasus) 9215b2fc499SJeff Garzik { 9225b2fc499SJeff Garzik usb_kill_urb(pegasus->intr_urb); 9235b2fc499SJeff Garzik usb_kill_urb(pegasus->tx_urb); 9245b2fc499SJeff Garzik usb_kill_urb(pegasus->rx_urb); 9255b2fc499SJeff Garzik usb_kill_urb(pegasus->ctrl_urb); 9265b2fc499SJeff Garzik } 9275b2fc499SJeff Garzik 9285b2fc499SJeff Garzik static int alloc_urbs(pegasus_t *pegasus) 9295b2fc499SJeff Garzik { 9305b2fc499SJeff Garzik pegasus->ctrl_urb = usb_alloc_urb(0, GFP_KERNEL); 9315a9dbfe0SNicolas Kaiser if (!pegasus->ctrl_urb) 9325b2fc499SJeff Garzik return 0; 9335b2fc499SJeff Garzik pegasus->rx_urb = usb_alloc_urb(0, GFP_KERNEL); 9345b2fc499SJeff Garzik if (!pegasus->rx_urb) { 9355b2fc499SJeff Garzik usb_free_urb(pegasus->ctrl_urb); 9365b2fc499SJeff Garzik return 0; 9375b2fc499SJeff Garzik } 9385b2fc499SJeff Garzik pegasus->tx_urb = usb_alloc_urb(0, GFP_KERNEL); 9395b2fc499SJeff Garzik if (!pegasus->tx_urb) { 9405b2fc499SJeff Garzik usb_free_urb(pegasus->rx_urb); 9415b2fc499SJeff Garzik usb_free_urb(pegasus->ctrl_urb); 9425b2fc499SJeff Garzik return 0; 9435b2fc499SJeff Garzik } 9445b2fc499SJeff Garzik pegasus->intr_urb = usb_alloc_urb(0, GFP_KERNEL); 9455b2fc499SJeff Garzik if (!pegasus->intr_urb) { 9465b2fc499SJeff Garzik usb_free_urb(pegasus->tx_urb); 9475b2fc499SJeff Garzik usb_free_urb(pegasus->rx_urb); 9485b2fc499SJeff Garzik usb_free_urb(pegasus->ctrl_urb); 9495b2fc499SJeff Garzik return 0; 9505b2fc499SJeff Garzik } 9515b2fc499SJeff Garzik 9525b2fc499SJeff Garzik return 1; 9535b2fc499SJeff Garzik } 9545b2fc499SJeff Garzik 9555b2fc499SJeff Garzik static int pegasus_open(struct net_device *net) 9565b2fc499SJeff Garzik { 9575b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 9585b2fc499SJeff Garzik int res; 9595b2fc499SJeff Garzik 9605b2fc499SJeff Garzik if (pegasus->rx_skb == NULL) 961*313a58e4SPetko Manolov pegasus->rx_skb = __netdev_alloc_skb_ip_align(pegasus->net, 962*313a58e4SPetko Manolov PEGASUS_MTU, 963*313a58e4SPetko Manolov GFP_KERNEL); 9645b2fc499SJeff Garzik if (!pegasus->rx_skb) 9655b2fc499SJeff Garzik return -ENOMEM; 9665b2fc499SJeff Garzik 9675b2fc499SJeff Garzik res = set_registers(pegasus, EthID, 6, net->dev_addr); 9685b2fc499SJeff Garzik 9695b2fc499SJeff Garzik usb_fill_bulk_urb(pegasus->rx_urb, pegasus->usb, 9705b2fc499SJeff Garzik usb_rcvbulkpipe(pegasus->usb, 1), 9715b2fc499SJeff Garzik pegasus->rx_skb->data, PEGASUS_MTU + 8, 9725b2fc499SJeff Garzik read_bulk_callback, pegasus); 9735b2fc499SJeff Garzik if ((res = usb_submit_urb(pegasus->rx_urb, GFP_KERNEL))) { 9745b2fc499SJeff Garzik if (res == -ENODEV) 9755b2fc499SJeff Garzik netif_device_detach(pegasus->net); 976a475f603SJoe Perches netif_dbg(pegasus, ifup, net, "failed rx_urb, %d\n", res); 9775b2fc499SJeff Garzik goto exit; 9785b2fc499SJeff Garzik } 9795b2fc499SJeff Garzik 9805b2fc499SJeff Garzik usb_fill_int_urb(pegasus->intr_urb, pegasus->usb, 9815b2fc499SJeff Garzik usb_rcvintpipe(pegasus->usb, 3), 9825b2fc499SJeff Garzik pegasus->intr_buff, sizeof(pegasus->intr_buff), 9835b2fc499SJeff Garzik intr_callback, pegasus, pegasus->intr_interval); 9845b2fc499SJeff Garzik if ((res = usb_submit_urb(pegasus->intr_urb, GFP_KERNEL))) { 9855b2fc499SJeff Garzik if (res == -ENODEV) 9865b2fc499SJeff Garzik netif_device_detach(pegasus->net); 987a475f603SJoe Perches netif_dbg(pegasus, ifup, net, "failed intr_urb, %d\n", res); 9885b2fc499SJeff Garzik usb_kill_urb(pegasus->rx_urb); 9895b2fc499SJeff Garzik goto exit; 9905b2fc499SJeff Garzik } 9915b2fc499SJeff Garzik if ((res = enable_net_traffic(net, pegasus->usb))) { 992a475f603SJoe Perches netif_dbg(pegasus, ifup, net, 993a475f603SJoe Perches "can't enable_net_traffic() - %d\n", res); 9945b2fc499SJeff Garzik res = -EIO; 9955b2fc499SJeff Garzik usb_kill_urb(pegasus->rx_urb); 9965b2fc499SJeff Garzik usb_kill_urb(pegasus->intr_urb); 9975b2fc499SJeff Garzik goto exit; 9985b2fc499SJeff Garzik } 9995b2fc499SJeff Garzik set_carrier(net); 10005b2fc499SJeff Garzik netif_start_queue(net); 1001a475f603SJoe Perches netif_dbg(pegasus, ifup, net, "open\n"); 10025b2fc499SJeff Garzik res = 0; 10035b2fc499SJeff Garzik exit: 10045b2fc499SJeff Garzik return res; 10055b2fc499SJeff Garzik } 10065b2fc499SJeff Garzik 10075b2fc499SJeff Garzik static int pegasus_close(struct net_device *net) 10085b2fc499SJeff Garzik { 10095b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 10105b2fc499SJeff Garzik 10115b2fc499SJeff Garzik netif_stop_queue(net); 10125b2fc499SJeff Garzik if (!(pegasus->flags & PEGASUS_UNPLUG)) 10135b2fc499SJeff Garzik disable_net_traffic(pegasus); 10145b2fc499SJeff Garzik tasklet_kill(&pegasus->rx_tl); 10155b2fc499SJeff Garzik unlink_all_urbs(pegasus); 10165b2fc499SJeff Garzik 10175b2fc499SJeff Garzik return 0; 10185b2fc499SJeff Garzik } 10195b2fc499SJeff Garzik 10205b2fc499SJeff Garzik static void pegasus_get_drvinfo(struct net_device *dev, 10215b2fc499SJeff Garzik struct ethtool_drvinfo *info) 10225b2fc499SJeff Garzik { 10235b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 10247826d43fSJiri Pirko 10257826d43fSJiri Pirko strlcpy(info->driver, driver_name, sizeof(info->driver)); 10267826d43fSJiri Pirko strlcpy(info->version, DRIVER_VERSION, sizeof(info->version)); 10275b2fc499SJeff Garzik usb_make_path(pegasus->usb, info->bus_info, sizeof(info->bus_info)); 10285b2fc499SJeff Garzik } 10295b2fc499SJeff Garzik 10305b2fc499SJeff Garzik /* also handles three patterns of some kind in hardware */ 10315b2fc499SJeff Garzik #define WOL_SUPPORTED (WAKE_MAGIC|WAKE_PHY) 10325b2fc499SJeff Garzik 10335b2fc499SJeff Garzik static void 10345b2fc499SJeff Garzik pegasus_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol) 10355b2fc499SJeff Garzik { 10365b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 10375b2fc499SJeff Garzik 10385b2fc499SJeff Garzik wol->supported = WAKE_MAGIC | WAKE_PHY; 10395b2fc499SJeff Garzik wol->wolopts = pegasus->wolopts; 10405b2fc499SJeff Garzik } 10415b2fc499SJeff Garzik 10425b2fc499SJeff Garzik static int 10435b2fc499SJeff Garzik pegasus_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol) 10445b2fc499SJeff Garzik { 10455b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 10465b2fc499SJeff Garzik u8 reg78 = 0x04; 10474fbc5b20SMing Lei int ret; 10485b2fc499SJeff Garzik 10495b2fc499SJeff Garzik if (wol->wolopts & ~WOL_SUPPORTED) 10505b2fc499SJeff Garzik return -EINVAL; 10515b2fc499SJeff Garzik 10525b2fc499SJeff Garzik if (wol->wolopts & WAKE_MAGIC) 10535b2fc499SJeff Garzik reg78 |= 0x80; 10545b2fc499SJeff Garzik if (wol->wolopts & WAKE_PHY) 10555b2fc499SJeff Garzik reg78 |= 0x40; 10565b2fc499SJeff Garzik /* FIXME this 0x10 bit still needs to get set in the chip... */ 10575b2fc499SJeff Garzik if (wol->wolopts) 10585b2fc499SJeff Garzik pegasus->eth_regs[0] |= 0x10; 10595b2fc499SJeff Garzik else 10605b2fc499SJeff Garzik pegasus->eth_regs[0] &= ~0x10; 10615b2fc499SJeff Garzik pegasus->wolopts = wol->wolopts; 10624fbc5b20SMing Lei 10634fbc5b20SMing Lei ret = set_register(pegasus, WakeupControl, reg78); 10644fbc5b20SMing Lei if (!ret) 10654fbc5b20SMing Lei ret = device_set_wakeup_enable(&pegasus->usb->dev, 10664fbc5b20SMing Lei wol->wolopts); 10674fbc5b20SMing Lei return ret; 10685b2fc499SJeff Garzik } 10695b2fc499SJeff Garzik 10705b2fc499SJeff Garzik static inline void pegasus_reset_wol(struct net_device *dev) 10715b2fc499SJeff Garzik { 10725b2fc499SJeff Garzik struct ethtool_wolinfo wol; 10735b2fc499SJeff Garzik 10745b2fc499SJeff Garzik memset(&wol, 0, sizeof wol); 10755b2fc499SJeff Garzik (void) pegasus_set_wol(dev, &wol); 10765b2fc499SJeff Garzik } 10775b2fc499SJeff Garzik 10785b2fc499SJeff Garzik static int 10795b2fc499SJeff Garzik pegasus_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd) 10805b2fc499SJeff Garzik { 10815b2fc499SJeff Garzik pegasus_t *pegasus; 10825b2fc499SJeff Garzik 10835b2fc499SJeff Garzik pegasus = netdev_priv(dev); 10845b2fc499SJeff Garzik mii_ethtool_gset(&pegasus->mii, ecmd); 10855b2fc499SJeff Garzik return 0; 10865b2fc499SJeff Garzik } 10875b2fc499SJeff Garzik 10885b2fc499SJeff Garzik static int 10895b2fc499SJeff Garzik pegasus_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd) 10905b2fc499SJeff Garzik { 10915b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 10925b2fc499SJeff Garzik return mii_ethtool_sset(&pegasus->mii, ecmd); 10935b2fc499SJeff Garzik } 10945b2fc499SJeff Garzik 10955b2fc499SJeff Garzik static int pegasus_nway_reset(struct net_device *dev) 10965b2fc499SJeff Garzik { 10975b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 10985b2fc499SJeff Garzik return mii_nway_restart(&pegasus->mii); 10995b2fc499SJeff Garzik } 11005b2fc499SJeff Garzik 11015b2fc499SJeff Garzik static u32 pegasus_get_link(struct net_device *dev) 11025b2fc499SJeff Garzik { 11035b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 11045b2fc499SJeff Garzik return mii_link_ok(&pegasus->mii); 11055b2fc499SJeff Garzik } 11065b2fc499SJeff Garzik 11075b2fc499SJeff Garzik static u32 pegasus_get_msglevel(struct net_device *dev) 11085b2fc499SJeff Garzik { 11095b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 11105b2fc499SJeff Garzik return pegasus->msg_enable; 11115b2fc499SJeff Garzik } 11125b2fc499SJeff Garzik 11135b2fc499SJeff Garzik static void pegasus_set_msglevel(struct net_device *dev, u32 v) 11145b2fc499SJeff Garzik { 11155b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(dev); 11165b2fc499SJeff Garzik pegasus->msg_enable = v; 11175b2fc499SJeff Garzik } 11185b2fc499SJeff Garzik 11190fc0b732SStephen Hemminger static const struct ethtool_ops ops = { 11205b2fc499SJeff Garzik .get_drvinfo = pegasus_get_drvinfo, 11215b2fc499SJeff Garzik .get_settings = pegasus_get_settings, 11225b2fc499SJeff Garzik .set_settings = pegasus_set_settings, 11235b2fc499SJeff Garzik .nway_reset = pegasus_nway_reset, 11245b2fc499SJeff Garzik .get_link = pegasus_get_link, 11255b2fc499SJeff Garzik .get_msglevel = pegasus_get_msglevel, 11265b2fc499SJeff Garzik .set_msglevel = pegasus_set_msglevel, 11275b2fc499SJeff Garzik .get_wol = pegasus_get_wol, 11285b2fc499SJeff Garzik .set_wol = pegasus_set_wol, 11295b2fc499SJeff Garzik }; 11305b2fc499SJeff Garzik 11315b2fc499SJeff Garzik static int pegasus_ioctl(struct net_device *net, struct ifreq *rq, int cmd) 11325b2fc499SJeff Garzik { 11335b2fc499SJeff Garzik __u16 *data = (__u16 *) &rq->ifr_ifru; 11345b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 11355b2fc499SJeff Garzik int res; 11365b2fc499SJeff Garzik 11375b2fc499SJeff Garzik switch (cmd) { 11385b2fc499SJeff Garzik case SIOCDEVPRIVATE: 11395b2fc499SJeff Garzik data[0] = pegasus->phy; 11405b2fc499SJeff Garzik case SIOCDEVPRIVATE + 1: 11415b2fc499SJeff Garzik read_mii_word(pegasus, data[0], data[1] & 0x1f, &data[3]); 11425b2fc499SJeff Garzik res = 0; 11435b2fc499SJeff Garzik break; 11445b2fc499SJeff Garzik case SIOCDEVPRIVATE + 2: 11455b2fc499SJeff Garzik if (!capable(CAP_NET_ADMIN)) 11465b2fc499SJeff Garzik return -EPERM; 11475b2fc499SJeff Garzik write_mii_word(pegasus, pegasus->phy, data[1] & 0x1f, data[2]); 11485b2fc499SJeff Garzik res = 0; 11495b2fc499SJeff Garzik break; 11505b2fc499SJeff Garzik default: 11515b2fc499SJeff Garzik res = -EOPNOTSUPP; 11525b2fc499SJeff Garzik } 11535b2fc499SJeff Garzik return res; 11545b2fc499SJeff Garzik } 11555b2fc499SJeff Garzik 11565b2fc499SJeff Garzik static void pegasus_set_multicast(struct net_device *net) 11575b2fc499SJeff Garzik { 11585b2fc499SJeff Garzik pegasus_t *pegasus = netdev_priv(net); 11595b2fc499SJeff Garzik 11605b2fc499SJeff Garzik if (net->flags & IFF_PROMISC) { 11615b2fc499SJeff Garzik pegasus->eth_regs[EthCtrl2] |= RX_PROMISCUOUS; 1162a475f603SJoe Perches netif_info(pegasus, link, net, "Promiscuous mode enabled\n"); 11634cd24eafSJiri Pirko } else if (!netdev_mc_empty(net) || (net->flags & IFF_ALLMULTI)) { 11645b2fc499SJeff Garzik pegasus->eth_regs[EthCtrl0] |= RX_MULTICAST; 11655b2fc499SJeff Garzik pegasus->eth_regs[EthCtrl2] &= ~RX_PROMISCUOUS; 1166a475f603SJoe Perches netif_dbg(pegasus, link, net, "set allmulti\n"); 11675b2fc499SJeff Garzik } else { 11685b2fc499SJeff Garzik pegasus->eth_regs[EthCtrl0] &= ~RX_MULTICAST; 11695b2fc499SJeff Garzik pegasus->eth_regs[EthCtrl2] &= ~RX_PROMISCUOUS; 11705b2fc499SJeff Garzik } 11715b2fc499SJeff Garzik 1172e000ea13SDavid Brownell pegasus->ctrl_urb->status = 0; 1173e000ea13SDavid Brownell 11745b2fc499SJeff Garzik pegasus->flags |= ETH_REGS_CHANGE; 11755b2fc499SJeff Garzik ctrl_callback(pegasus->ctrl_urb); 11765b2fc499SJeff Garzik } 11775b2fc499SJeff Garzik 11785b2fc499SJeff Garzik static __u8 mii_phy_probe(pegasus_t *pegasus) 11795b2fc499SJeff Garzik { 11805b2fc499SJeff Garzik int i; 11815b2fc499SJeff Garzik __u16 tmp; 11825b2fc499SJeff Garzik 11835b2fc499SJeff Garzik for (i = 0; i < 32; i++) { 11845b2fc499SJeff Garzik read_mii_word(pegasus, i, MII_BMSR, &tmp); 11855b2fc499SJeff Garzik if (tmp == 0 || tmp == 0xffff || (tmp & BMSR_MEDIA) == 0) 11865b2fc499SJeff Garzik continue; 11875b2fc499SJeff Garzik else 11885b2fc499SJeff Garzik return i; 11895b2fc499SJeff Garzik } 11905b2fc499SJeff Garzik 11915b2fc499SJeff Garzik return 0xff; 11925b2fc499SJeff Garzik } 11935b2fc499SJeff Garzik 11945b2fc499SJeff Garzik static inline void setup_pegasus_II(pegasus_t *pegasus) 11955b2fc499SJeff Garzik { 11965b2fc499SJeff Garzik __u8 data = 0xa5; 11975b2fc499SJeff Garzik 11985b2fc499SJeff Garzik set_register(pegasus, Reg1d, 0); 11995b2fc499SJeff Garzik set_register(pegasus, Reg7b, 1); 12005b2fc499SJeff Garzik mdelay(100); 12015b2fc499SJeff Garzik if ((pegasus->features & HAS_HOME_PNA) && mii_mode) 12025b2fc499SJeff Garzik set_register(pegasus, Reg7b, 0); 12035b2fc499SJeff Garzik else 12045b2fc499SJeff Garzik set_register(pegasus, Reg7b, 2); 12055b2fc499SJeff Garzik 12065b2fc499SJeff Garzik set_register(pegasus, 0x83, data); 12075b2fc499SJeff Garzik get_registers(pegasus, 0x83, 1, &data); 12085b2fc499SJeff Garzik 12095a9dbfe0SNicolas Kaiser if (data == 0xa5) 12105b2fc499SJeff Garzik pegasus->chip = 0x8513; 12115a9dbfe0SNicolas Kaiser else 12125b2fc499SJeff Garzik pegasus->chip = 0; 12135b2fc499SJeff Garzik 12145b2fc499SJeff Garzik set_register(pegasus, 0x80, 0xc0); 12155b2fc499SJeff Garzik set_register(pegasus, 0x83, 0xff); 12165b2fc499SJeff Garzik set_register(pegasus, 0x84, 0x01); 12175b2fc499SJeff Garzik 12185b2fc499SJeff Garzik if (pegasus->features & HAS_HOME_PNA && mii_mode) 12195b2fc499SJeff Garzik set_register(pegasus, Reg81, 6); 12205b2fc499SJeff Garzik else 12215b2fc499SJeff Garzik set_register(pegasus, Reg81, 2); 12225b2fc499SJeff Garzik } 12235b2fc499SJeff Garzik 12245b2fc499SJeff Garzik 1225cda2836dSDavid Brownell static int pegasus_count; 12265a9dbfe0SNicolas Kaiser static struct workqueue_struct *pegasus_workqueue; 12275b2fc499SJeff Garzik #define CARRIER_CHECK_DELAY (2 * HZ) 12285b2fc499SJeff Garzik 12295b2fc499SJeff Garzik static void check_carrier(struct work_struct *work) 12305b2fc499SJeff Garzik { 12315b2fc499SJeff Garzik pegasus_t *pegasus = container_of(work, pegasus_t, carrier_check.work); 12325b2fc499SJeff Garzik set_carrier(pegasus->net); 12335b2fc499SJeff Garzik if (!(pegasus->flags & PEGASUS_UNPLUG)) { 12345b2fc499SJeff Garzik queue_delayed_work(pegasus_workqueue, &pegasus->carrier_check, 12355b2fc499SJeff Garzik CARRIER_CHECK_DELAY); 12365b2fc499SJeff Garzik } 12375b2fc499SJeff Garzik } 12385b2fc499SJeff Garzik 12394f63135eSBen Collins static int pegasus_blacklisted(struct usb_device *udev) 12404f63135eSBen Collins { 12414f63135eSBen Collins struct usb_device_descriptor *udd = &udev->descriptor; 12424f63135eSBen Collins 12434f63135eSBen Collins /* Special quirk to keep the driver from handling the Belkin Bluetooth 12444f63135eSBen Collins * dongle which happens to have the same ID. 12454f63135eSBen Collins */ 1246e3453f63SMichael Buesch if ((udd->idVendor == cpu_to_le16(VENDOR_BELKIN)) && 1247e3453f63SMichael Buesch (udd->idProduct == cpu_to_le16(0x0121)) && 12484f63135eSBen Collins (udd->bDeviceClass == USB_CLASS_WIRELESS_CONTROLLER) && 12494f63135eSBen Collins (udd->bDeviceProtocol == 1)) 12504f63135eSBen Collins return 1; 12514f63135eSBen Collins 12524f63135eSBen Collins return 0; 12534f63135eSBen Collins } 12544f63135eSBen Collins 1255cda2836dSDavid Brownell /* we rely on probe() and remove() being serialized so we 1256cda2836dSDavid Brownell * don't need extra locking on pegasus_count. 1257cda2836dSDavid Brownell */ 1258cda2836dSDavid Brownell static void pegasus_dec_workqueue(void) 1259cda2836dSDavid Brownell { 1260cda2836dSDavid Brownell pegasus_count--; 1261cda2836dSDavid Brownell if (pegasus_count == 0) { 1262cda2836dSDavid Brownell destroy_workqueue(pegasus_workqueue); 1263cda2836dSDavid Brownell pegasus_workqueue = NULL; 1264cda2836dSDavid Brownell } 1265cda2836dSDavid Brownell } 1266cda2836dSDavid Brownell 12675b2fc499SJeff Garzik static int pegasus_probe(struct usb_interface *intf, 12685b2fc499SJeff Garzik const struct usb_device_id *id) 12695b2fc499SJeff Garzik { 12705b2fc499SJeff Garzik struct usb_device *dev = interface_to_usbdev(intf); 12715b2fc499SJeff Garzik struct net_device *net; 12725b2fc499SJeff Garzik pegasus_t *pegasus; 12735b2fc499SJeff Garzik int dev_index = id - pegasus_ids; 12745b2fc499SJeff Garzik int res = -ENOMEM; 12755b2fc499SJeff Garzik 1276cda2836dSDavid Brownell if (pegasus_blacklisted(dev)) 1277cda2836dSDavid Brownell return -ENODEV; 12784f63135eSBen Collins 1279cda2836dSDavid Brownell if (pegasus_count == 0) { 1280cda2836dSDavid Brownell pegasus_workqueue = create_singlethread_workqueue("pegasus"); 1281cda2836dSDavid Brownell if (!pegasus_workqueue) 1282cda2836dSDavid Brownell return -ENOMEM; 12834f63135eSBen Collins } 1284cda2836dSDavid Brownell pegasus_count++; 1285cda2836dSDavid Brownell 12865b2fc499SJeff Garzik net = alloc_etherdev(sizeof(struct pegasus)); 128741de8d4cSJoe Perches if (!net) 12885b2fc499SJeff Garzik goto out; 12895b2fc499SJeff Garzik 12905b2fc499SJeff Garzik pegasus = netdev_priv(net); 12915b2fc499SJeff Garzik pegasus->dev_index = dev_index; 12925b2fc499SJeff Garzik init_waitqueue_head(&pegasus->ctrl_wait); 12935b2fc499SJeff Garzik 12945b2fc499SJeff Garzik if (!alloc_urbs(pegasus)) { 12955b2fc499SJeff Garzik dev_err(&intf->dev, "can't allocate %s\n", "urbs"); 12965b2fc499SJeff Garzik goto out1; 12975b2fc499SJeff Garzik } 12985b2fc499SJeff Garzik 12995b2fc499SJeff Garzik tasklet_init(&pegasus->rx_tl, rx_fixup, (unsigned long) pegasus); 13005b2fc499SJeff Garzik 13015b2fc499SJeff Garzik INIT_DELAYED_WORK(&pegasus->carrier_check, check_carrier); 13025b2fc499SJeff Garzik 13035b2fc499SJeff Garzik pegasus->intf = intf; 13045b2fc499SJeff Garzik pegasus->usb = dev; 13055b2fc499SJeff Garzik pegasus->net = net; 13068cb89571SOliver Neukum 13078cb89571SOliver Neukum 13085b2fc499SJeff Garzik net->watchdog_timeo = PEGASUS_TX_TIMEOUT; 13098cb89571SOliver Neukum net->netdev_ops = &pegasus_netdev_ops; 13105b2fc499SJeff Garzik SET_ETHTOOL_OPS(net, &ops); 13115b2fc499SJeff Garzik pegasus->mii.dev = net; 13125b2fc499SJeff Garzik pegasus->mii.mdio_read = mdio_read; 13135b2fc499SJeff Garzik pegasus->mii.mdio_write = mdio_write; 13145b2fc499SJeff Garzik pegasus->mii.phy_id_mask = 0x1f; 13155b2fc499SJeff Garzik pegasus->mii.reg_num_mask = 0x1f; 13165b2fc499SJeff Garzik pegasus->msg_enable = netif_msg_init(msg_level, NETIF_MSG_DRV 13175b2fc499SJeff Garzik | NETIF_MSG_PROBE | NETIF_MSG_LINK); 13185b2fc499SJeff Garzik 13195b2fc499SJeff Garzik pegasus->features = usb_dev_id[dev_index].private; 13205b2fc499SJeff Garzik get_interrupt_interval(pegasus); 13215b2fc499SJeff Garzik if (reset_mac(pegasus)) { 13225b2fc499SJeff Garzik dev_err(&intf->dev, "can't reset MAC\n"); 13235b2fc499SJeff Garzik res = -EIO; 13245b2fc499SJeff Garzik goto out2; 13255b2fc499SJeff Garzik } 13265b2fc499SJeff Garzik set_ethernet_addr(pegasus); 13275b2fc499SJeff Garzik if (pegasus->features & PEGASUS_II) { 13285b2fc499SJeff Garzik dev_info(&intf->dev, "setup Pegasus II specific registers\n"); 13295b2fc499SJeff Garzik setup_pegasus_II(pegasus); 13305b2fc499SJeff Garzik } 13315b2fc499SJeff Garzik pegasus->phy = mii_phy_probe(pegasus); 13325b2fc499SJeff Garzik if (pegasus->phy == 0xff) { 13335b2fc499SJeff Garzik dev_warn(&intf->dev, "can't locate MII phy, using default\n"); 13345b2fc499SJeff Garzik pegasus->phy = 1; 13355b2fc499SJeff Garzik } 13365b2fc499SJeff Garzik pegasus->mii.phy_id = pegasus->phy; 13375b2fc499SJeff Garzik usb_set_intfdata(intf, pegasus); 13385b2fc499SJeff Garzik SET_NETDEV_DEV(net, &intf->dev); 13395b2fc499SJeff Garzik pegasus_reset_wol(net); 13405b2fc499SJeff Garzik res = register_netdev(net); 13415b2fc499SJeff Garzik if (res) 13425b2fc499SJeff Garzik goto out3; 13435b2fc499SJeff Garzik queue_delayed_work(pegasus_workqueue, &pegasus->carrier_check, 13445b2fc499SJeff Garzik CARRIER_CHECK_DELAY); 13455b2fc499SJeff Garzik 1346e174961cSJohannes Berg dev_info(&intf->dev, "%s, %s, %pM\n", 13475b2fc499SJeff Garzik net->name, 13485b2fc499SJeff Garzik usb_dev_id[dev_index].name, 1349e174961cSJohannes Berg net->dev_addr); 13505b2fc499SJeff Garzik return 0; 13515b2fc499SJeff Garzik 13525b2fc499SJeff Garzik out3: 13535b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 13545b2fc499SJeff Garzik out2: 13555b2fc499SJeff Garzik free_all_urbs(pegasus); 13565b2fc499SJeff Garzik out1: 13575b2fc499SJeff Garzik free_netdev(net); 13585b2fc499SJeff Garzik out: 1359cda2836dSDavid Brownell pegasus_dec_workqueue(); 13605b2fc499SJeff Garzik return res; 13615b2fc499SJeff Garzik } 13625b2fc499SJeff Garzik 13635b2fc499SJeff Garzik static void pegasus_disconnect(struct usb_interface *intf) 13645b2fc499SJeff Garzik { 13655b2fc499SJeff Garzik struct pegasus *pegasus = usb_get_intfdata(intf); 13665b2fc499SJeff Garzik 13675b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 13685b2fc499SJeff Garzik if (!pegasus) { 13695b2fc499SJeff Garzik dev_dbg(&intf->dev, "unregistering non-bound device?\n"); 13705b2fc499SJeff Garzik return; 13715b2fc499SJeff Garzik } 13725b2fc499SJeff Garzik 13735b2fc499SJeff Garzik pegasus->flags |= PEGASUS_UNPLUG; 13745b2fc499SJeff Garzik cancel_delayed_work(&pegasus->carrier_check); 13755b2fc499SJeff Garzik unregister_netdev(pegasus->net); 13765b2fc499SJeff Garzik unlink_all_urbs(pegasus); 13775b2fc499SJeff Garzik free_all_urbs(pegasus); 13785b2fc499SJeff Garzik if (pegasus->rx_skb != NULL) { 13795b2fc499SJeff Garzik dev_kfree_skb(pegasus->rx_skb); 13805b2fc499SJeff Garzik pegasus->rx_skb = NULL; 13815b2fc499SJeff Garzik } 13825b2fc499SJeff Garzik free_netdev(pegasus->net); 1383cda2836dSDavid Brownell pegasus_dec_workqueue(); 13845b2fc499SJeff Garzik } 13855b2fc499SJeff Garzik 13865b2fc499SJeff Garzik static int pegasus_suspend(struct usb_interface *intf, pm_message_t message) 13875b2fc499SJeff Garzik { 13885b2fc499SJeff Garzik struct pegasus *pegasus = usb_get_intfdata(intf); 13895b2fc499SJeff Garzik 13905b2fc499SJeff Garzik netif_device_detach(pegasus->net); 13915b2fc499SJeff Garzik cancel_delayed_work(&pegasus->carrier_check); 13925b2fc499SJeff Garzik if (netif_running(pegasus->net)) { 13935b2fc499SJeff Garzik usb_kill_urb(pegasus->rx_urb); 13945b2fc499SJeff Garzik usb_kill_urb(pegasus->intr_urb); 13955b2fc499SJeff Garzik } 13965b2fc499SJeff Garzik return 0; 13975b2fc499SJeff Garzik } 13985b2fc499SJeff Garzik 13995b2fc499SJeff Garzik static int pegasus_resume(struct usb_interface *intf) 14005b2fc499SJeff Garzik { 14015b2fc499SJeff Garzik struct pegasus *pegasus = usb_get_intfdata(intf); 14025b2fc499SJeff Garzik 14035b2fc499SJeff Garzik netif_device_attach(pegasus->net); 14045b2fc499SJeff Garzik if (netif_running(pegasus->net)) { 14055b2fc499SJeff Garzik pegasus->rx_urb->status = 0; 14065b2fc499SJeff Garzik pegasus->rx_urb->actual_length = 0; 14075b2fc499SJeff Garzik read_bulk_callback(pegasus->rx_urb); 14085b2fc499SJeff Garzik 14095b2fc499SJeff Garzik pegasus->intr_urb->status = 0; 14105b2fc499SJeff Garzik pegasus->intr_urb->actual_length = 0; 14115b2fc499SJeff Garzik intr_callback(pegasus->intr_urb); 14125b2fc499SJeff Garzik } 14135b2fc499SJeff Garzik queue_delayed_work(pegasus_workqueue, &pegasus->carrier_check, 14145b2fc499SJeff Garzik CARRIER_CHECK_DELAY); 14155b2fc499SJeff Garzik return 0; 14165b2fc499SJeff Garzik } 14175b2fc499SJeff Garzik 14188cb89571SOliver Neukum static const struct net_device_ops pegasus_netdev_ops = { 14198cb89571SOliver Neukum .ndo_open = pegasus_open, 14208cb89571SOliver Neukum .ndo_stop = pegasus_close, 14218cb89571SOliver Neukum .ndo_do_ioctl = pegasus_ioctl, 14228cb89571SOliver Neukum .ndo_start_xmit = pegasus_start_xmit, 1423afc4b13dSJiri Pirko .ndo_set_rx_mode = pegasus_set_multicast, 14248cb89571SOliver Neukum .ndo_get_stats = pegasus_netdev_stats, 14258cb89571SOliver Neukum .ndo_tx_timeout = pegasus_tx_timeout, 1426635ecaa7SBen Hutchings .ndo_change_mtu = eth_change_mtu, 1427240c102dSBen Hutchings .ndo_set_mac_address = eth_mac_addr, 1428240c102dSBen Hutchings .ndo_validate_addr = eth_validate_addr, 14298cb89571SOliver Neukum }; 14308cb89571SOliver Neukum 14315b2fc499SJeff Garzik static struct usb_driver pegasus_driver = { 14325b2fc499SJeff Garzik .name = driver_name, 14335b2fc499SJeff Garzik .probe = pegasus_probe, 14345b2fc499SJeff Garzik .disconnect = pegasus_disconnect, 14355b2fc499SJeff Garzik .id_table = pegasus_ids, 14365b2fc499SJeff Garzik .suspend = pegasus_suspend, 14375b2fc499SJeff Garzik .resume = pegasus_resume, 1438e1f12eb6SSarah Sharp .disable_hub_initiated_lpm = 1, 14395b2fc499SJeff Garzik }; 14405b2fc499SJeff Garzik 1441cda2836dSDavid Brownell static void __init parse_id(char *id) 14425b2fc499SJeff Garzik { 14435b2fc499SJeff Garzik unsigned int vendor_id = 0, device_id = 0, flags = 0, i = 0; 14445b2fc499SJeff Garzik char *token, *name = NULL; 14455b2fc499SJeff Garzik 14465b2fc499SJeff Garzik if ((token = strsep(&id, ":")) != NULL) 14475b2fc499SJeff Garzik name = token; 14485b2fc499SJeff Garzik /* name now points to a null terminated string*/ 14495b2fc499SJeff Garzik if ((token = strsep(&id, ":")) != NULL) 14505b2fc499SJeff Garzik vendor_id = simple_strtoul(token, NULL, 16); 14515b2fc499SJeff Garzik if ((token = strsep(&id, ":")) != NULL) 14525b2fc499SJeff Garzik device_id = simple_strtoul(token, NULL, 16); 14535b2fc499SJeff Garzik flags = simple_strtoul(id, NULL, 16); 14545b2fc499SJeff Garzik pr_info("%s: new device %s, vendor ID 0x%04x, device ID 0x%04x, flags: 0x%x\n", 14555b2fc499SJeff Garzik driver_name, name, vendor_id, device_id, flags); 14565b2fc499SJeff Garzik 14575b2fc499SJeff Garzik if (vendor_id > 0x10000 || vendor_id == 0) 14585b2fc499SJeff Garzik return; 14595b2fc499SJeff Garzik if (device_id > 0x10000 || device_id == 0) 14605b2fc499SJeff Garzik return; 14615b2fc499SJeff Garzik 14625b2fc499SJeff Garzik for (i = 0; usb_dev_id[i].name; i++); 14635b2fc499SJeff Garzik usb_dev_id[i].name = name; 14645b2fc499SJeff Garzik usb_dev_id[i].vendor = vendor_id; 14655b2fc499SJeff Garzik usb_dev_id[i].device = device_id; 14665b2fc499SJeff Garzik usb_dev_id[i].private = flags; 14675b2fc499SJeff Garzik pegasus_ids[i].match_flags = USB_DEVICE_ID_MATCH_DEVICE; 14685b2fc499SJeff Garzik pegasus_ids[i].idVendor = vendor_id; 14695b2fc499SJeff Garzik pegasus_ids[i].idProduct = device_id; 14705b2fc499SJeff Garzik } 14715b2fc499SJeff Garzik 14725b2fc499SJeff Garzik static int __init pegasus_init(void) 14735b2fc499SJeff Garzik { 14745b2fc499SJeff Garzik pr_info("%s: %s, " DRIVER_DESC "\n", driver_name, DRIVER_VERSION); 14755b2fc499SJeff Garzik if (devid) 14765b2fc499SJeff Garzik parse_id(devid); 14775b2fc499SJeff Garzik return usb_register(&pegasus_driver); 14785b2fc499SJeff Garzik } 14795b2fc499SJeff Garzik 14805b2fc499SJeff Garzik static void __exit pegasus_exit(void) 14815b2fc499SJeff Garzik { 14825b2fc499SJeff Garzik usb_deregister(&pegasus_driver); 14835b2fc499SJeff Garzik } 14845b2fc499SJeff Garzik 14855b2fc499SJeff Garzik module_init(pegasus_init); 14865b2fc499SJeff Garzik module_exit(pegasus_exit); 1487