1aaf4989bSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 25b2fc499SJeff Garzik /**************************************************************** 35b2fc499SJeff Garzik * 45b2fc499SJeff Garzik * kaweth.c - driver for KL5KUSB101 based USB->Ethernet 55b2fc499SJeff Garzik * 65b2fc499SJeff Garzik * (c) 2000 Interlan Communications 75b2fc499SJeff Garzik * (c) 2000 Stephane Alnet 85b2fc499SJeff Garzik * (C) 2001 Brad Hards 95b2fc499SJeff Garzik * (C) 2002 Oliver Neukum 105b2fc499SJeff Garzik * 115b2fc499SJeff Garzik * Original author: The Zapman <zapman@interlan.net> 125b2fc499SJeff Garzik * Inspired by, and much credit goes to Michael Rothwell 135b2fc499SJeff Garzik * <rothwell@interlan.net> for the test equipment, help, and patience 145b2fc499SJeff Garzik * Based off of (and with thanks to) Petko Manolov's pegaus.c driver. 155b2fc499SJeff Garzik * Also many thanks to Joel Silverman and Ed Surprenant at Kawasaki 165b2fc499SJeff Garzik * for providing the firmware and driver resources. 175b2fc499SJeff Garzik * 185b2fc499SJeff Garzik ****************************************************************/ 195b2fc499SJeff Garzik 205b2fc499SJeff Garzik /* TODO: 215b2fc499SJeff Garzik * Develop test procedures for USB net interfaces 225b2fc499SJeff Garzik * Run test procedures 235b2fc499SJeff Garzik * Fix bugs from previous two steps 245b2fc499SJeff Garzik * Snoop other OSs for any tricks we're not doing 255b2fc499SJeff Garzik * Reduce arbitrary timeouts 265b2fc499SJeff Garzik * Smart multicast support 275b2fc499SJeff Garzik * Temporary MAC change support 285b2fc499SJeff Garzik * Tunable SOFs parameter - ioctl()? 295b2fc499SJeff Garzik * Ethernet stats collection 305b2fc499SJeff Garzik * Code formatting improvements 315b2fc499SJeff Garzik */ 325b2fc499SJeff Garzik 335b2fc499SJeff Garzik #include <linux/module.h> 345b2fc499SJeff Garzik #include <linux/slab.h> 355b2fc499SJeff Garzik #include <linux/string.h> 365b2fc499SJeff Garzik #include <linux/delay.h> 375b2fc499SJeff Garzik #include <linux/netdevice.h> 385b2fc499SJeff Garzik #include <linux/etherdevice.h> 395b2fc499SJeff Garzik #include <linux/usb.h> 405b2fc499SJeff Garzik #include <linux/types.h> 415b2fc499SJeff Garzik #include <linux/ethtool.h> 425b2fc499SJeff Garzik #include <linux/dma-mapping.h> 435b2fc499SJeff Garzik #include <linux/wait.h> 4479682499SDavid Woodhouse #include <linux/firmware.h> 457c0f6ba6SLinus Torvalds #include <linux/uaccess.h> 465b2fc499SJeff Garzik #include <asm/byteorder.h> 475b2fc499SJeff Garzik 485b2fc499SJeff Garzik #undef DEBUG 495b2fc499SJeff Garzik 505b2fc499SJeff Garzik #define KAWETH_MTU 1514 515b2fc499SJeff Garzik #define KAWETH_BUF_SIZE 1664 525b2fc499SJeff Garzik #define KAWETH_TX_TIMEOUT (5 * HZ) 535b2fc499SJeff Garzik #define KAWETH_SCRATCH_SIZE 32 545b2fc499SJeff Garzik #define KAWETH_FIRMWARE_BUF_SIZE 4096 552b2b2e35SRuss Dill #define KAWETH_CONTROL_TIMEOUT (30000) 565b2fc499SJeff Garzik 575b2fc499SJeff Garzik #define KAWETH_STATUS_BROKEN 0x0000001 585b2fc499SJeff Garzik #define KAWETH_STATUS_CLOSING 0x0000002 595b2fc499SJeff Garzik #define KAWETH_STATUS_SUSPENDING 0x0000004 605b2fc499SJeff Garzik 615b2fc499SJeff Garzik #define KAWETH_STATUS_BLOCKED (KAWETH_STATUS_CLOSING | KAWETH_STATUS_SUSPENDING) 625b2fc499SJeff Garzik 635b2fc499SJeff Garzik #define KAWETH_PACKET_FILTER_PROMISCUOUS 0x01 645b2fc499SJeff Garzik #define KAWETH_PACKET_FILTER_ALL_MULTICAST 0x02 655b2fc499SJeff Garzik #define KAWETH_PACKET_FILTER_DIRECTED 0x04 665b2fc499SJeff Garzik #define KAWETH_PACKET_FILTER_BROADCAST 0x08 675b2fc499SJeff Garzik #define KAWETH_PACKET_FILTER_MULTICAST 0x10 685b2fc499SJeff Garzik 695b2fc499SJeff Garzik /* Table 7 */ 705b2fc499SJeff Garzik #define KAWETH_COMMAND_GET_ETHERNET_DESC 0x00 715b2fc499SJeff Garzik #define KAWETH_COMMAND_MULTICAST_FILTERS 0x01 725b2fc499SJeff Garzik #define KAWETH_COMMAND_SET_PACKET_FILTER 0x02 735b2fc499SJeff Garzik #define KAWETH_COMMAND_STATISTICS 0x03 745b2fc499SJeff Garzik #define KAWETH_COMMAND_SET_TEMP_MAC 0x06 755b2fc499SJeff Garzik #define KAWETH_COMMAND_GET_TEMP_MAC 0x07 765b2fc499SJeff Garzik #define KAWETH_COMMAND_SET_URB_SIZE 0x08 775b2fc499SJeff Garzik #define KAWETH_COMMAND_SET_SOFS_WAIT 0x09 785b2fc499SJeff Garzik #define KAWETH_COMMAND_SCAN 0xFF 795b2fc499SJeff Garzik 805b2fc499SJeff Garzik #define KAWETH_SOFS_TO_WAIT 0x05 815b2fc499SJeff Garzik 825b2fc499SJeff Garzik #define INTBUFFERSIZE 4 835b2fc499SJeff Garzik 845b2fc499SJeff Garzik #define STATE_OFFSET 0 855b2fc499SJeff Garzik #define STATE_MASK 0x40 865b2fc499SJeff Garzik #define STATE_SHIFT 5 875b2fc499SJeff Garzik 885b2fc499SJeff Garzik #define IS_BLOCKED(s) (s & KAWETH_STATUS_BLOCKED) 895b2fc499SJeff Garzik 905b2fc499SJeff Garzik 915b2fc499SJeff Garzik MODULE_AUTHOR("Michael Zappe <zapman@interlan.net>, Stephane Alnet <stephane@u-picardie.fr>, Brad Hards <bhards@bigpond.net.au> and Oliver Neukum <oliver@neukum.org>"); 925b2fc499SJeff Garzik MODULE_DESCRIPTION("KL5USB101 USB Ethernet driver"); 935b2fc499SJeff Garzik MODULE_LICENSE("GPL"); 9479682499SDavid Woodhouse MODULE_FIRMWARE("kaweth/new_code.bin"); 9579682499SDavid Woodhouse MODULE_FIRMWARE("kaweth/new_code_fix.bin"); 9679682499SDavid Woodhouse MODULE_FIRMWARE("kaweth/trigger_code.bin"); 9779682499SDavid Woodhouse MODULE_FIRMWARE("kaweth/trigger_code_fix.bin"); 985b2fc499SJeff Garzik 995b2fc499SJeff Garzik static const char driver_name[] = "kaweth"; 1005b2fc499SJeff Garzik 1015b2fc499SJeff Garzik static int kaweth_probe( 1025b2fc499SJeff Garzik struct usb_interface *intf, 1035b2fc499SJeff Garzik const struct usb_device_id *id /* from id_table */ 1045b2fc499SJeff Garzik ); 1055b2fc499SJeff Garzik static void kaweth_disconnect(struct usb_interface *intf); 1065b2fc499SJeff Garzik static int kaweth_internal_control_msg(struct usb_device *usb_dev, 1075b2fc499SJeff Garzik unsigned int pipe, 1085b2fc499SJeff Garzik struct usb_ctrlrequest *cmd, void *data, 1095b2fc499SJeff Garzik int len, int timeout); 1105b2fc499SJeff Garzik static int kaweth_suspend(struct usb_interface *intf, pm_message_t message); 1115b2fc499SJeff Garzik static int kaweth_resume(struct usb_interface *intf); 1125b2fc499SJeff Garzik 1135b2fc499SJeff Garzik /**************************************************************** 1145b2fc499SJeff Garzik * usb_device_id 1155b2fc499SJeff Garzik ****************************************************************/ 11606fa59a0SArvind Yadav static const struct usb_device_id usb_klsi_table[] = { 1175b2fc499SJeff Garzik { USB_DEVICE(0x03e8, 0x0008) }, /* AOX Endpoints USB Ethernet */ 1185b2fc499SJeff Garzik { USB_DEVICE(0x04bb, 0x0901) }, /* I-O DATA USB-ET/T */ 1195b2fc499SJeff Garzik { USB_DEVICE(0x0506, 0x03e8) }, /* 3Com 3C19250 */ 1205b2fc499SJeff Garzik { USB_DEVICE(0x0506, 0x11f8) }, /* 3Com 3C460 */ 1215b2fc499SJeff Garzik { USB_DEVICE(0x0557, 0x2002) }, /* ATEN USB Ethernet */ 1225b2fc499SJeff Garzik { USB_DEVICE(0x0557, 0x4000) }, /* D-Link DSB-650C */ 1235b2fc499SJeff Garzik { USB_DEVICE(0x0565, 0x0002) }, /* Peracom Enet */ 1245b2fc499SJeff Garzik { USB_DEVICE(0x0565, 0x0003) }, /* Optus@Home UEP1045A */ 1255b2fc499SJeff Garzik { USB_DEVICE(0x0565, 0x0005) }, /* Peracom Enet2 */ 1265b2fc499SJeff Garzik { USB_DEVICE(0x05e9, 0x0008) }, /* KLSI KL5KUSB101B */ 1275b2fc499SJeff Garzik { USB_DEVICE(0x05e9, 0x0009) }, /* KLSI KL5KUSB101B (Board change) */ 1285b2fc499SJeff Garzik { USB_DEVICE(0x066b, 0x2202) }, /* Linksys USB10T */ 1295b2fc499SJeff Garzik { USB_DEVICE(0x06e1, 0x0008) }, /* ADS USB-10BT */ 1305b2fc499SJeff Garzik { USB_DEVICE(0x06e1, 0x0009) }, /* ADS USB-10BT */ 1315b2fc499SJeff Garzik { USB_DEVICE(0x0707, 0x0100) }, /* SMC 2202USB */ 1325b2fc499SJeff Garzik { USB_DEVICE(0x07aa, 0x0001) }, /* Correga K.K. */ 1335b2fc499SJeff Garzik { USB_DEVICE(0x07b8, 0x4000) }, /* D-Link DU-E10 */ 134dacf4fc8SAndreas Hartmann { USB_DEVICE(0x07c9, 0xb010) }, /* Allied Telesyn AT-USB10 USB Ethernet Adapter */ 1355b2fc499SJeff Garzik { USB_DEVICE(0x0846, 0x1001) }, /* NetGear EA-101 */ 1365b2fc499SJeff Garzik { USB_DEVICE(0x0846, 0x1002) }, /* NetGear EA-101 */ 1375b2fc499SJeff Garzik { USB_DEVICE(0x085a, 0x0008) }, /* PortGear Ethernet Adapter */ 1385b2fc499SJeff Garzik { USB_DEVICE(0x085a, 0x0009) }, /* PortGear Ethernet Adapter */ 1395b2fc499SJeff Garzik { USB_DEVICE(0x087d, 0x5704) }, /* Jaton USB Ethernet Device Adapter */ 1405b2fc499SJeff Garzik { USB_DEVICE(0x0951, 0x0008) }, /* Kingston Technology USB Ethernet Adapter */ 1415b2fc499SJeff Garzik { USB_DEVICE(0x095a, 0x3003) }, /* Portsmith Express Ethernet Adapter */ 1425b2fc499SJeff Garzik { USB_DEVICE(0x10bd, 0x1427) }, /* ASANTE USB To Ethernet Adapter */ 1435b2fc499SJeff Garzik { USB_DEVICE(0x1342, 0x0204) }, /* Mobility USB-Ethernet Adapter */ 1445b2fc499SJeff Garzik { USB_DEVICE(0x13d2, 0x0400) }, /* Shark Pocket Adapter */ 1455b2fc499SJeff Garzik { USB_DEVICE(0x1485, 0x0001) }, /* Silicom U2E */ 1465b2fc499SJeff Garzik { USB_DEVICE(0x1485, 0x0002) }, /* Psion Dacom Gold Port Ethernet */ 1475b2fc499SJeff Garzik { USB_DEVICE(0x1645, 0x0005) }, /* Entrega E45 */ 1485b2fc499SJeff Garzik { USB_DEVICE(0x1645, 0x0008) }, /* Entrega USB Ethernet Adapter */ 1495b2fc499SJeff Garzik { USB_DEVICE(0x1645, 0x8005) }, /* PortGear Ethernet Adapter */ 1505b2fc499SJeff Garzik { USB_DEVICE(0x1668, 0x0323) }, /* Actiontec USB Ethernet */ 1515b2fc499SJeff Garzik { USB_DEVICE(0x2001, 0x4000) }, /* D-link DSB-650C */ 1525b2fc499SJeff Garzik {} /* Null terminator */ 1535b2fc499SJeff Garzik }; 1545b2fc499SJeff Garzik 1555b2fc499SJeff Garzik MODULE_DEVICE_TABLE (usb, usb_klsi_table); 1565b2fc499SJeff Garzik 1575b2fc499SJeff Garzik /**************************************************************** 1585b2fc499SJeff Garzik * kaweth_driver 1595b2fc499SJeff Garzik ****************************************************************/ 1605b2fc499SJeff Garzik static struct usb_driver kaweth_driver = { 1615b2fc499SJeff Garzik .name = driver_name, 1625b2fc499SJeff Garzik .probe = kaweth_probe, 1635b2fc499SJeff Garzik .disconnect = kaweth_disconnect, 1645b2fc499SJeff Garzik .suspend = kaweth_suspend, 1655b2fc499SJeff Garzik .resume = kaweth_resume, 1665b2fc499SJeff Garzik .id_table = usb_klsi_table, 1675b2fc499SJeff Garzik .supports_autosuspend = 1, 168e1f12eb6SSarah Sharp .disable_hub_initiated_lpm = 1, 1695b2fc499SJeff Garzik }; 1705b2fc499SJeff Garzik 1715b2fc499SJeff Garzik typedef __u8 eth_addr_t[6]; 1725b2fc499SJeff Garzik 1735b2fc499SJeff Garzik /**************************************************************** 1745b2fc499SJeff Garzik * usb_eth_dev 1755b2fc499SJeff Garzik ****************************************************************/ 1765b2fc499SJeff Garzik struct usb_eth_dev { 1775b2fc499SJeff Garzik char *name; 1785b2fc499SJeff Garzik __u16 vendor; 1795b2fc499SJeff Garzik __u16 device; 1805b2fc499SJeff Garzik void *pdata; 1815b2fc499SJeff Garzik }; 1825b2fc499SJeff Garzik 1835b2fc499SJeff Garzik /**************************************************************** 1845b2fc499SJeff Garzik * kaweth_ethernet_configuration 1855b2fc499SJeff Garzik * Refer Table 8 1865b2fc499SJeff Garzik ****************************************************************/ 1875b2fc499SJeff Garzik struct kaweth_ethernet_configuration 1885b2fc499SJeff Garzik { 1895b2fc499SJeff Garzik __u8 size; 1905b2fc499SJeff Garzik __u8 reserved1; 1915b2fc499SJeff Garzik __u8 reserved2; 1925b2fc499SJeff Garzik eth_addr_t hw_addr; 1935b2fc499SJeff Garzik __u32 statistics_mask; 1945b2fc499SJeff Garzik __le16 segment_size; 1955b2fc499SJeff Garzik __u16 max_multicast_filters; 1965b2fc499SJeff Garzik __u8 reserved3; 197ba2d3587SEric Dumazet } __packed; 1985b2fc499SJeff Garzik 1995b2fc499SJeff Garzik /**************************************************************** 2005b2fc499SJeff Garzik * kaweth_device 2015b2fc499SJeff Garzik ****************************************************************/ 2025b2fc499SJeff Garzik struct kaweth_device 2035b2fc499SJeff Garzik { 2045b2fc499SJeff Garzik spinlock_t device_lock; 2055b2fc499SJeff Garzik 2065b2fc499SJeff Garzik __u32 status; 2075b2fc499SJeff Garzik int end; 2085b2fc499SJeff Garzik int suspend_lowmem_rx; 2095b2fc499SJeff Garzik int suspend_lowmem_ctrl; 2105b2fc499SJeff Garzik int linkstate; 2115b2fc499SJeff Garzik int opened; 2125b2fc499SJeff Garzik struct delayed_work lowmem_work; 2135b2fc499SJeff Garzik 2145b2fc499SJeff Garzik struct usb_device *dev; 2155b2fc499SJeff Garzik struct usb_interface *intf; 2165b2fc499SJeff Garzik struct net_device *net; 2175b2fc499SJeff Garzik wait_queue_head_t term_wait; 2185b2fc499SJeff Garzik 2195b2fc499SJeff Garzik struct urb *rx_urb; 2205b2fc499SJeff Garzik struct urb *tx_urb; 2215b2fc499SJeff Garzik struct urb *irq_urb; 2225b2fc499SJeff Garzik 2235b2fc499SJeff Garzik dma_addr_t intbufferhandle; 2245b2fc499SJeff Garzik __u8 *intbuffer; 2255b2fc499SJeff Garzik dma_addr_t rxbufferhandle; 2265b2fc499SJeff Garzik __u8 *rx_buf; 2275b2fc499SJeff Garzik 2285b2fc499SJeff Garzik 2295b2fc499SJeff Garzik struct sk_buff *tx_skb; 2305b2fc499SJeff Garzik 2315b2fc499SJeff Garzik __u8 *firmware_buf; 2325b2fc499SJeff Garzik __u8 scratch[KAWETH_SCRATCH_SIZE]; 2335b2fc499SJeff Garzik __u16 packet_filter_bitmap; 2345b2fc499SJeff Garzik 2355b2fc499SJeff Garzik struct kaweth_ethernet_configuration configuration; 2365b2fc499SJeff Garzik }; 2375b2fc499SJeff Garzik 2385b2fc499SJeff Garzik /**************************************************************** 2395b2fc499SJeff Garzik * kaweth_control 2405b2fc499SJeff Garzik ****************************************************************/ 2415b2fc499SJeff Garzik static int kaweth_control(struct kaweth_device *kaweth, 2425b2fc499SJeff Garzik unsigned int pipe, 2435b2fc499SJeff Garzik __u8 request, 2445b2fc499SJeff Garzik __u8 requesttype, 2455b2fc499SJeff Garzik __u16 value, 2465b2fc499SJeff Garzik __u16 index, 2475b2fc499SJeff Garzik void *data, 2485b2fc499SJeff Garzik __u16 size, 2495b2fc499SJeff Garzik int timeout) 2505b2fc499SJeff Garzik { 2515b2fc499SJeff Garzik struct usb_ctrlrequest *dr; 252051b982bSKevin Cernekee int retval; 2535b2fc499SJeff Garzik 2545b2fc499SJeff Garzik if(in_interrupt()) { 25549ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "in_interrupt()\n"); 2565b2fc499SJeff Garzik return -EBUSY; 2575b2fc499SJeff Garzik } 2585b2fc499SJeff Garzik 2595b2fc499SJeff Garzik dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC); 26049ae25b0SGreg Kroah-Hartman if (!dr) 2615b2fc499SJeff Garzik return -ENOMEM; 2625b2fc499SJeff Garzik 2635b2fc499SJeff Garzik dr->bRequestType = requesttype; 2645b2fc499SJeff Garzik dr->bRequest = request; 265da2bbdccSHarvey Harrison dr->wValue = cpu_to_le16(value); 266da2bbdccSHarvey Harrison dr->wIndex = cpu_to_le16(index); 267da2bbdccSHarvey Harrison dr->wLength = cpu_to_le16(size); 2685b2fc499SJeff Garzik 269051b982bSKevin Cernekee retval = kaweth_internal_control_msg(kaweth->dev, 2705b2fc499SJeff Garzik pipe, 2715b2fc499SJeff Garzik dr, 2725b2fc499SJeff Garzik data, 2735b2fc499SJeff Garzik size, 2745b2fc499SJeff Garzik timeout); 275051b982bSKevin Cernekee 276051b982bSKevin Cernekee kfree(dr); 277051b982bSKevin Cernekee return retval; 2785b2fc499SJeff Garzik } 2795b2fc499SJeff Garzik 2805b2fc499SJeff Garzik /**************************************************************** 2815b2fc499SJeff Garzik * kaweth_read_configuration 2825b2fc499SJeff Garzik ****************************************************************/ 2835b2fc499SJeff Garzik static int kaweth_read_configuration(struct kaweth_device *kaweth) 2845b2fc499SJeff Garzik { 2855b2fc499SJeff Garzik int retval; 2865b2fc499SJeff Garzik 2875b2fc499SJeff Garzik retval = kaweth_control(kaweth, 2885b2fc499SJeff Garzik usb_rcvctrlpipe(kaweth->dev, 0), 2895b2fc499SJeff Garzik KAWETH_COMMAND_GET_ETHERNET_DESC, 2905b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE, 2915b2fc499SJeff Garzik 0, 2925b2fc499SJeff Garzik 0, 2935b2fc499SJeff Garzik (void *)&kaweth->configuration, 2945b2fc499SJeff Garzik sizeof(kaweth->configuration), 2955b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 2965b2fc499SJeff Garzik 2975b2fc499SJeff Garzik return retval; 2985b2fc499SJeff Garzik } 2995b2fc499SJeff Garzik 3005b2fc499SJeff Garzik /**************************************************************** 3015b2fc499SJeff Garzik * kaweth_set_urb_size 3025b2fc499SJeff Garzik ****************************************************************/ 3035b2fc499SJeff Garzik static int kaweth_set_urb_size(struct kaweth_device *kaweth, __u16 urb_size) 3045b2fc499SJeff Garzik { 3055b2fc499SJeff Garzik int retval; 3065b2fc499SJeff Garzik 30749ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "Setting URB size to %d\n", (unsigned)urb_size); 3085b2fc499SJeff Garzik 3095b2fc499SJeff Garzik retval = kaweth_control(kaweth, 3105b2fc499SJeff Garzik usb_sndctrlpipe(kaweth->dev, 0), 3115b2fc499SJeff Garzik KAWETH_COMMAND_SET_URB_SIZE, 3125b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, 3135b2fc499SJeff Garzik urb_size, 3145b2fc499SJeff Garzik 0, 3155b2fc499SJeff Garzik (void *)&kaweth->scratch, 3165b2fc499SJeff Garzik 0, 3175b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 3185b2fc499SJeff Garzik 3195b2fc499SJeff Garzik return retval; 3205b2fc499SJeff Garzik } 3215b2fc499SJeff Garzik 3225b2fc499SJeff Garzik /**************************************************************** 3235b2fc499SJeff Garzik * kaweth_set_sofs_wait 3245b2fc499SJeff Garzik ****************************************************************/ 3255b2fc499SJeff Garzik static int kaweth_set_sofs_wait(struct kaweth_device *kaweth, __u16 sofs_wait) 3265b2fc499SJeff Garzik { 3275b2fc499SJeff Garzik int retval; 3285b2fc499SJeff Garzik 32949ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "Set SOFS wait to %d\n", (unsigned)sofs_wait); 3305b2fc499SJeff Garzik 3315b2fc499SJeff Garzik retval = kaweth_control(kaweth, 3325b2fc499SJeff Garzik usb_sndctrlpipe(kaweth->dev, 0), 3335b2fc499SJeff Garzik KAWETH_COMMAND_SET_SOFS_WAIT, 3345b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, 3355b2fc499SJeff Garzik sofs_wait, 3365b2fc499SJeff Garzik 0, 3375b2fc499SJeff Garzik (void *)&kaweth->scratch, 3385b2fc499SJeff Garzik 0, 3395b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 3405b2fc499SJeff Garzik 3415b2fc499SJeff Garzik return retval; 3425b2fc499SJeff Garzik } 3435b2fc499SJeff Garzik 3445b2fc499SJeff Garzik /**************************************************************** 3455b2fc499SJeff Garzik * kaweth_set_receive_filter 3465b2fc499SJeff Garzik ****************************************************************/ 3475b2fc499SJeff Garzik static int kaweth_set_receive_filter(struct kaweth_device *kaweth, 3485b2fc499SJeff Garzik __u16 receive_filter) 3495b2fc499SJeff Garzik { 3505b2fc499SJeff Garzik int retval; 3515b2fc499SJeff Garzik 35249ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "Set receive filter to %d\n", 35349ae25b0SGreg Kroah-Hartman (unsigned)receive_filter); 3545b2fc499SJeff Garzik 3555b2fc499SJeff Garzik retval = kaweth_control(kaweth, 3565b2fc499SJeff Garzik usb_sndctrlpipe(kaweth->dev, 0), 3575b2fc499SJeff Garzik KAWETH_COMMAND_SET_PACKET_FILTER, 3585b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, 3595b2fc499SJeff Garzik receive_filter, 3605b2fc499SJeff Garzik 0, 3615b2fc499SJeff Garzik (void *)&kaweth->scratch, 3625b2fc499SJeff Garzik 0, 3635b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 3645b2fc499SJeff Garzik 3655b2fc499SJeff Garzik return retval; 3665b2fc499SJeff Garzik } 3675b2fc499SJeff Garzik 3685b2fc499SJeff Garzik /**************************************************************** 3695b2fc499SJeff Garzik * kaweth_download_firmware 3705b2fc499SJeff Garzik ****************************************************************/ 3715b2fc499SJeff Garzik static int kaweth_download_firmware(struct kaweth_device *kaweth, 37279682499SDavid Woodhouse const char *fwname, 3735b2fc499SJeff Garzik __u8 interrupt, 3745b2fc499SJeff Garzik __u8 type) 3755b2fc499SJeff Garzik { 37679682499SDavid Woodhouse const struct firmware *fw; 37779682499SDavid Woodhouse int data_len; 37879682499SDavid Woodhouse int ret; 37979682499SDavid Woodhouse 38079682499SDavid Woodhouse ret = request_firmware(&fw, fwname, &kaweth->dev->dev); 38179682499SDavid Woodhouse if (ret) { 382db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "Firmware request failed\n"); 38379682499SDavid Woodhouse return ret; 3845b2fc499SJeff Garzik } 3855b2fc499SJeff Garzik 38679682499SDavid Woodhouse if (fw->size > KAWETH_FIRMWARE_BUF_SIZE) { 387db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "Firmware too big: %zu\n", 388db6b2219SGreg Kroah-Hartman fw->size); 389986e3f6eSJesper Juhl release_firmware(fw); 39079682499SDavid Woodhouse return -ENOSPC; 39179682499SDavid Woodhouse } 39279682499SDavid Woodhouse data_len = fw->size; 39379682499SDavid Woodhouse memcpy(kaweth->firmware_buf, fw->data, fw->size); 39479682499SDavid Woodhouse 39579682499SDavid Woodhouse release_firmware(fw); 3965b2fc499SJeff Garzik 3975b2fc499SJeff Garzik kaweth->firmware_buf[2] = (data_len & 0xFF) - 7; 3985b2fc499SJeff Garzik kaweth->firmware_buf[3] = data_len >> 8; 3995b2fc499SJeff Garzik kaweth->firmware_buf[4] = type; 4005b2fc499SJeff Garzik kaweth->firmware_buf[5] = interrupt; 4015b2fc499SJeff Garzik 40249ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "High: %i, Low:%i\n", kaweth->firmware_buf[3], 4035b2fc499SJeff Garzik kaweth->firmware_buf[2]); 4045b2fc499SJeff Garzik 40549ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, 40649ae25b0SGreg Kroah-Hartman "Downloading firmware at %p to kaweth device at %p\n", 4070abc1ceeSAlan Cox kaweth->firmware_buf, kaweth); 40849ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "Firmware length: %d\n", data_len); 4095b2fc499SJeff Garzik 4105b2fc499SJeff Garzik return kaweth_control(kaweth, 4115b2fc499SJeff Garzik usb_sndctrlpipe(kaweth->dev, 0), 4125b2fc499SJeff Garzik KAWETH_COMMAND_SCAN, 4135b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, 4145b2fc499SJeff Garzik 0, 4155b2fc499SJeff Garzik 0, 4165b2fc499SJeff Garzik (void *)kaweth->firmware_buf, 4175b2fc499SJeff Garzik data_len, 4185b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 4195b2fc499SJeff Garzik } 4205b2fc499SJeff Garzik 4215b2fc499SJeff Garzik /**************************************************************** 4225b2fc499SJeff Garzik * kaweth_trigger_firmware 4235b2fc499SJeff Garzik ****************************************************************/ 4245b2fc499SJeff Garzik static int kaweth_trigger_firmware(struct kaweth_device *kaweth, 4255b2fc499SJeff Garzik __u8 interrupt) 4265b2fc499SJeff Garzik { 4275b2fc499SJeff Garzik kaweth->firmware_buf[0] = 0xB6; 4285b2fc499SJeff Garzik kaweth->firmware_buf[1] = 0xC3; 4295b2fc499SJeff Garzik kaweth->firmware_buf[2] = 0x01; 4305b2fc499SJeff Garzik kaweth->firmware_buf[3] = 0x00; 4315b2fc499SJeff Garzik kaweth->firmware_buf[4] = 0x06; 4325b2fc499SJeff Garzik kaweth->firmware_buf[5] = interrupt; 4335b2fc499SJeff Garzik kaweth->firmware_buf[6] = 0x00; 4345b2fc499SJeff Garzik kaweth->firmware_buf[7] = 0x00; 4355b2fc499SJeff Garzik 4365b2fc499SJeff Garzik return kaweth_control(kaweth, 4375b2fc499SJeff Garzik usb_sndctrlpipe(kaweth->dev, 0), 4385b2fc499SJeff Garzik KAWETH_COMMAND_SCAN, 4395b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, 4405b2fc499SJeff Garzik 0, 4415b2fc499SJeff Garzik 0, 4425b2fc499SJeff Garzik (void *)kaweth->firmware_buf, 4435b2fc499SJeff Garzik 8, 4445b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 4455b2fc499SJeff Garzik } 4465b2fc499SJeff Garzik 4475b2fc499SJeff Garzik /**************************************************************** 4485b2fc499SJeff Garzik * kaweth_reset 4495b2fc499SJeff Garzik ****************************************************************/ 4505b2fc499SJeff Garzik static int kaweth_reset(struct kaweth_device *kaweth) 4515b2fc499SJeff Garzik { 4525b2fc499SJeff Garzik int result; 4535b2fc499SJeff Garzik 454f0816ce3SOliver Neukum result = usb_reset_configuration(kaweth->dev); 4555b2fc499SJeff Garzik mdelay(10); 4565b2fc499SJeff Garzik 45749ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "kaweth_reset() returns %d.\n", result); 4585b2fc499SJeff Garzik 4595b2fc499SJeff Garzik return result; 4605b2fc499SJeff Garzik } 4615b2fc499SJeff Garzik 4625b2fc499SJeff Garzik static void kaweth_usb_receive(struct urb *); 4635b2fc499SJeff Garzik static int kaweth_resubmit_rx_urb(struct kaweth_device *, gfp_t); 4645b2fc499SJeff Garzik 4655b2fc499SJeff Garzik /**************************************************************** 4665b2fc499SJeff Garzik int_callback 4675b2fc499SJeff Garzik *****************************************************************/ 4685b2fc499SJeff Garzik 4695b2fc499SJeff Garzik static void kaweth_resubmit_int_urb(struct kaweth_device *kaweth, gfp_t mf) 4705b2fc499SJeff Garzik { 4715b2fc499SJeff Garzik int status; 4725b2fc499SJeff Garzik 4735b2fc499SJeff Garzik status = usb_submit_urb (kaweth->irq_urb, mf); 4745b2fc499SJeff Garzik if (unlikely(status == -ENOMEM)) { 4755b2fc499SJeff Garzik kaweth->suspend_lowmem_ctrl = 1; 4765b2fc499SJeff Garzik schedule_delayed_work(&kaweth->lowmem_work, HZ/4); 4775b2fc499SJeff Garzik } else { 4785b2fc499SJeff Garzik kaweth->suspend_lowmem_ctrl = 0; 4795b2fc499SJeff Garzik } 4805b2fc499SJeff Garzik 4815b2fc499SJeff Garzik if (status) 482db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, 483db6b2219SGreg Kroah-Hartman "can't resubmit intr, %s-%s, status %d\n", 4845b2fc499SJeff Garzik kaweth->dev->bus->bus_name, 4855b2fc499SJeff Garzik kaweth->dev->devpath, status); 4865b2fc499SJeff Garzik } 4875b2fc499SJeff Garzik 4885b2fc499SJeff Garzik static void int_callback(struct urb *u) 4895b2fc499SJeff Garzik { 4905b2fc499SJeff Garzik struct kaweth_device *kaweth = u->context; 4915b2fc499SJeff Garzik int act_state; 492c94cb314SOliver Neukum int status = u->status; 4935b2fc499SJeff Garzik 494c94cb314SOliver Neukum switch (status) { 4955b2fc499SJeff Garzik case 0: /* success */ 4965b2fc499SJeff Garzik break; 4975b2fc499SJeff Garzik case -ECONNRESET: /* unlink */ 4985b2fc499SJeff Garzik case -ENOENT: 4995b2fc499SJeff Garzik case -ESHUTDOWN: 5005b2fc499SJeff Garzik return; 5015b2fc499SJeff Garzik /* -EPIPE: should clear the halt */ 5025b2fc499SJeff Garzik default: /* error */ 5035b2fc499SJeff Garzik goto resubmit; 5045b2fc499SJeff Garzik } 5055b2fc499SJeff Garzik 5065b2fc499SJeff Garzik /* we check the link state to report changes */ 5075b2fc499SJeff Garzik if (kaweth->linkstate != (act_state = ( kaweth->intbuffer[STATE_OFFSET] | STATE_MASK) >> STATE_SHIFT)) { 5085b2fc499SJeff Garzik if (act_state) 5095b2fc499SJeff Garzik netif_carrier_on(kaweth->net); 5105b2fc499SJeff Garzik else 5115b2fc499SJeff Garzik netif_carrier_off(kaweth->net); 5125b2fc499SJeff Garzik 5135b2fc499SJeff Garzik kaweth->linkstate = act_state; 5145b2fc499SJeff Garzik } 5155b2fc499SJeff Garzik resubmit: 5165b2fc499SJeff Garzik kaweth_resubmit_int_urb(kaweth, GFP_ATOMIC); 5175b2fc499SJeff Garzik } 5185b2fc499SJeff Garzik 5195b2fc499SJeff Garzik static void kaweth_resubmit_tl(struct work_struct *work) 5205b2fc499SJeff Garzik { 5215b2fc499SJeff Garzik struct kaweth_device *kaweth = 5225b2fc499SJeff Garzik container_of(work, struct kaweth_device, lowmem_work.work); 5235b2fc499SJeff Garzik 5245b2fc499SJeff Garzik if (IS_BLOCKED(kaweth->status)) 5255b2fc499SJeff Garzik return; 5265b2fc499SJeff Garzik 5275b2fc499SJeff Garzik if (kaweth->suspend_lowmem_rx) 5285b2fc499SJeff Garzik kaweth_resubmit_rx_urb(kaweth, GFP_NOIO); 5295b2fc499SJeff Garzik 5305b2fc499SJeff Garzik if (kaweth->suspend_lowmem_ctrl) 5315b2fc499SJeff Garzik kaweth_resubmit_int_urb(kaweth, GFP_NOIO); 5325b2fc499SJeff Garzik } 5335b2fc499SJeff Garzik 5345b2fc499SJeff Garzik 5355b2fc499SJeff Garzik /**************************************************************** 5365b2fc499SJeff Garzik * kaweth_resubmit_rx_urb 5375b2fc499SJeff Garzik ****************************************************************/ 5385b2fc499SJeff Garzik static int kaweth_resubmit_rx_urb(struct kaweth_device *kaweth, 5395b2fc499SJeff Garzik gfp_t mem_flags) 5405b2fc499SJeff Garzik { 5415b2fc499SJeff Garzik int result; 5425b2fc499SJeff Garzik 5435b2fc499SJeff Garzik usb_fill_bulk_urb(kaweth->rx_urb, 5445b2fc499SJeff Garzik kaweth->dev, 5455b2fc499SJeff Garzik usb_rcvbulkpipe(kaweth->dev, 1), 5465b2fc499SJeff Garzik kaweth->rx_buf, 5475b2fc499SJeff Garzik KAWETH_BUF_SIZE, 5485b2fc499SJeff Garzik kaweth_usb_receive, 5495b2fc499SJeff Garzik kaweth); 5505b2fc499SJeff Garzik kaweth->rx_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 5515b2fc499SJeff Garzik kaweth->rx_urb->transfer_dma = kaweth->rxbufferhandle; 5525b2fc499SJeff Garzik 5535b2fc499SJeff Garzik if((result = usb_submit_urb(kaweth->rx_urb, mem_flags))) { 5545b2fc499SJeff Garzik if (result == -ENOMEM) { 5555b2fc499SJeff Garzik kaweth->suspend_lowmem_rx = 1; 5565b2fc499SJeff Garzik schedule_delayed_work(&kaweth->lowmem_work, HZ/4); 5575b2fc499SJeff Garzik } 558db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "resubmitting rx_urb %d failed\n", 559db6b2219SGreg Kroah-Hartman result); 5605b2fc499SJeff Garzik } else { 5615b2fc499SJeff Garzik kaweth->suspend_lowmem_rx = 0; 5625b2fc499SJeff Garzik } 5635b2fc499SJeff Garzik 5645b2fc499SJeff Garzik return result; 5655b2fc499SJeff Garzik } 5665b2fc499SJeff Garzik 5675b2fc499SJeff Garzik static void kaweth_async_set_rx_mode(struct kaweth_device *kaweth); 5685b2fc499SJeff Garzik 5695b2fc499SJeff Garzik /**************************************************************** 5705b2fc499SJeff Garzik * kaweth_usb_receive 5715b2fc499SJeff Garzik ****************************************************************/ 5725b2fc499SJeff Garzik static void kaweth_usb_receive(struct urb *urb) 5735b2fc499SJeff Garzik { 57449ae25b0SGreg Kroah-Hartman struct device *dev = &urb->dev->dev; 5755b2fc499SJeff Garzik struct kaweth_device *kaweth = urb->context; 5765b2fc499SJeff Garzik struct net_device *net = kaweth->net; 577c94cb314SOliver Neukum int status = urb->status; 578ba49fed8SSebastian Andrzej Siewior unsigned long flags; 5795b2fc499SJeff Garzik int count = urb->actual_length; 5805b2fc499SJeff Garzik int count2 = urb->transfer_buffer_length; 5815b2fc499SJeff Garzik 5825b2fc499SJeff Garzik __u16 pkt_len = le16_to_cpup((__le16 *)kaweth->rx_buf); 5835b2fc499SJeff Garzik 5845b2fc499SJeff Garzik struct sk_buff *skb; 5855b2fc499SJeff Garzik 586710b523aSLarry Finger if (unlikely(status == -EPIPE)) { 5876ffa770eSTobias Klauser net->stats.rx_errors++; 5885b2fc499SJeff Garzik kaweth->end = 1; 5895b2fc499SJeff Garzik wake_up(&kaweth->term_wait); 59049ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Status was -EPIPE.\n"); 5915b2fc499SJeff Garzik return; 5925b2fc499SJeff Garzik } 593710b523aSLarry Finger if (unlikely(status == -ECONNRESET || status == -ESHUTDOWN)) { 594710b523aSLarry Finger /* we are killed - set a flag and wake the disconnect handler */ 595710b523aSLarry Finger kaweth->end = 1; 596710b523aSLarry Finger wake_up(&kaweth->term_wait); 59749ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Status was -ECONNRESET or -ESHUTDOWN.\n"); 598710b523aSLarry Finger return; 599710b523aSLarry Finger } 600710b523aSLarry Finger if (unlikely(status == -EPROTO || status == -ETIME || 601710b523aSLarry Finger status == -EILSEQ)) { 6026ffa770eSTobias Klauser net->stats.rx_errors++; 60349ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Status was -EPROTO, -ETIME, or -EILSEQ.\n"); 604710b523aSLarry Finger return; 605710b523aSLarry Finger } 606710b523aSLarry Finger if (unlikely(status == -EOVERFLOW)) { 6076ffa770eSTobias Klauser net->stats.rx_errors++; 60849ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Status was -EOVERFLOW.\n"); 609710b523aSLarry Finger } 610ba49fed8SSebastian Andrzej Siewior spin_lock_irqsave(&kaweth->device_lock, flags); 6115b2fc499SJeff Garzik if (IS_BLOCKED(kaweth->status)) { 612ba49fed8SSebastian Andrzej Siewior spin_unlock_irqrestore(&kaweth->device_lock, flags); 6135b2fc499SJeff Garzik return; 6145b2fc499SJeff Garzik } 615ba49fed8SSebastian Andrzej Siewior spin_unlock_irqrestore(&kaweth->device_lock, flags); 6165b2fc499SJeff Garzik 617c94cb314SOliver Neukum if(status && status != -EREMOTEIO && count != 1) { 618db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, 619db6b2219SGreg Kroah-Hartman "%s RX status: %d count: %d packet_len: %d\n", 620db6b2219SGreg Kroah-Hartman net->name, status, count, (int)pkt_len); 6215b2fc499SJeff Garzik kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); 6225b2fc499SJeff Garzik return; 6235b2fc499SJeff Garzik } 6245b2fc499SJeff Garzik 6255b2fc499SJeff Garzik if(kaweth->net && (count > 2)) { 6265b2fc499SJeff Garzik if(pkt_len > (count - 2)) { 627db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, 628db6b2219SGreg Kroah-Hartman "Packet length too long for USB frame (pkt_len: %x, count: %x)\n", 629db6b2219SGreg Kroah-Hartman pkt_len, count); 630db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "Packet len & 2047: %x\n", 631db6b2219SGreg Kroah-Hartman pkt_len & 2047); 632db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "Count 2: %x\n", count2); 6335b2fc499SJeff Garzik kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); 6345b2fc499SJeff Garzik return; 6355b2fc499SJeff Garzik } 6365b2fc499SJeff Garzik 6375b2fc499SJeff Garzik if(!(skb = dev_alloc_skb(pkt_len+2))) { 6385b2fc499SJeff Garzik kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); 6395b2fc499SJeff Garzik return; 6405b2fc499SJeff Garzik } 6415b2fc499SJeff Garzik 6425b2fc499SJeff Garzik skb_reserve(skb, 2); /* Align IP on 16 byte boundaries */ 6435b2fc499SJeff Garzik 6448c7b7faaSDavid S. Miller skb_copy_to_linear_data(skb, kaweth->rx_buf + 2, pkt_len); 6455b2fc499SJeff Garzik 6465b2fc499SJeff Garzik skb_put(skb, pkt_len); 6475b2fc499SJeff Garzik 6485b2fc499SJeff Garzik skb->protocol = eth_type_trans(skb, net); 6495b2fc499SJeff Garzik 6505b2fc499SJeff Garzik netif_rx(skb); 6515b2fc499SJeff Garzik 6526ffa770eSTobias Klauser net->stats.rx_packets++; 6536ffa770eSTobias Klauser net->stats.rx_bytes += pkt_len; 6545b2fc499SJeff Garzik } 6555b2fc499SJeff Garzik 6565b2fc499SJeff Garzik kaweth_resubmit_rx_urb(kaweth, GFP_ATOMIC); 6575b2fc499SJeff Garzik } 6585b2fc499SJeff Garzik 6595b2fc499SJeff Garzik /**************************************************************** 6605b2fc499SJeff Garzik * kaweth_open 6615b2fc499SJeff Garzik ****************************************************************/ 6625b2fc499SJeff Garzik static int kaweth_open(struct net_device *net) 6635b2fc499SJeff Garzik { 6645b2fc499SJeff Garzik struct kaweth_device *kaweth = netdev_priv(net); 6655b2fc499SJeff Garzik int res; 6665b2fc499SJeff Garzik 6675b2fc499SJeff Garzik res = usb_autopm_get_interface(kaweth->intf); 6685b2fc499SJeff Garzik if (res) { 669db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "Interface cannot be resumed.\n"); 6705b2fc499SJeff Garzik return -EIO; 6715b2fc499SJeff Garzik } 6725b2fc499SJeff Garzik res = kaweth_resubmit_rx_urb(kaweth, GFP_KERNEL); 6735b2fc499SJeff Garzik if (res) 6745b2fc499SJeff Garzik goto err_out; 6755b2fc499SJeff Garzik 6765b2fc499SJeff Garzik usb_fill_int_urb( 6775b2fc499SJeff Garzik kaweth->irq_urb, 6785b2fc499SJeff Garzik kaweth->dev, 6795b2fc499SJeff Garzik usb_rcvintpipe(kaweth->dev, 3), 6805b2fc499SJeff Garzik kaweth->intbuffer, 6815b2fc499SJeff Garzik INTBUFFERSIZE, 6825b2fc499SJeff Garzik int_callback, 6835b2fc499SJeff Garzik kaweth, 6845b2fc499SJeff Garzik 250); /* overriding the descriptor */ 6855b2fc499SJeff Garzik kaweth->irq_urb->transfer_dma = kaweth->intbufferhandle; 6865b2fc499SJeff Garzik kaweth->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 6875b2fc499SJeff Garzik 6885b2fc499SJeff Garzik res = usb_submit_urb(kaweth->irq_urb, GFP_KERNEL); 6895b2fc499SJeff Garzik if (res) { 6905b2fc499SJeff Garzik usb_kill_urb(kaweth->rx_urb); 6915b2fc499SJeff Garzik goto err_out; 6925b2fc499SJeff Garzik } 6935b2fc499SJeff Garzik kaweth->opened = 1; 6945b2fc499SJeff Garzik 6955b2fc499SJeff Garzik netif_start_queue(net); 6965b2fc499SJeff Garzik 6975b2fc499SJeff Garzik kaweth_async_set_rx_mode(kaweth); 6985b2fc499SJeff Garzik return 0; 6995b2fc499SJeff Garzik 7005b2fc499SJeff Garzik err_out: 701ceb0c77eSOliver Neukum usb_autopm_put_interface(kaweth->intf); 7025b2fc499SJeff Garzik return -EIO; 7035b2fc499SJeff Garzik } 7045b2fc499SJeff Garzik 7055b2fc499SJeff Garzik /**************************************************************** 7065b2fc499SJeff Garzik * kaweth_kill_urbs 7075b2fc499SJeff Garzik ****************************************************************/ 7085b2fc499SJeff Garzik static void kaweth_kill_urbs(struct kaweth_device *kaweth) 7095b2fc499SJeff Garzik { 7105b2fc499SJeff Garzik usb_kill_urb(kaweth->irq_urb); 7115b2fc499SJeff Garzik usb_kill_urb(kaweth->rx_urb); 7125b2fc499SJeff Garzik usb_kill_urb(kaweth->tx_urb); 7135b2fc499SJeff Garzik 7144bb073c0SDavid S. Miller cancel_delayed_work_sync(&kaweth->lowmem_work); 7155b2fc499SJeff Garzik 7165b2fc499SJeff Garzik /* a scheduled work may have resubmitted, 7175b2fc499SJeff Garzik we hit them again */ 7185b2fc499SJeff Garzik usb_kill_urb(kaweth->irq_urb); 7195b2fc499SJeff Garzik usb_kill_urb(kaweth->rx_urb); 7205b2fc499SJeff Garzik } 7215b2fc499SJeff Garzik 7225b2fc499SJeff Garzik /**************************************************************** 7235b2fc499SJeff Garzik * kaweth_close 7245b2fc499SJeff Garzik ****************************************************************/ 7255b2fc499SJeff Garzik static int kaweth_close(struct net_device *net) 7265b2fc499SJeff Garzik { 7275b2fc499SJeff Garzik struct kaweth_device *kaweth = netdev_priv(net); 7285b2fc499SJeff Garzik 7295b2fc499SJeff Garzik netif_stop_queue(net); 7305b2fc499SJeff Garzik kaweth->opened = 0; 7315b2fc499SJeff Garzik 7325b2fc499SJeff Garzik kaweth->status |= KAWETH_STATUS_CLOSING; 7335b2fc499SJeff Garzik 7345b2fc499SJeff Garzik kaweth_kill_urbs(kaweth); 7355b2fc499SJeff Garzik 7365b2fc499SJeff Garzik kaweth->status &= ~KAWETH_STATUS_CLOSING; 7375b2fc499SJeff Garzik 738ceb0c77eSOliver Neukum usb_autopm_put_interface(kaweth->intf); 7395b2fc499SJeff Garzik 7405b2fc499SJeff Garzik return 0; 7415b2fc499SJeff Garzik } 7425b2fc499SJeff Garzik 7435b2fc499SJeff Garzik static u32 kaweth_get_link(struct net_device *dev) 7445b2fc499SJeff Garzik { 7455b2fc499SJeff Garzik struct kaweth_device *kaweth = netdev_priv(dev); 7465b2fc499SJeff Garzik 7475b2fc499SJeff Garzik return kaweth->linkstate; 7485b2fc499SJeff Garzik } 7495b2fc499SJeff Garzik 7500fc0b732SStephen Hemminger static const struct ethtool_ops ops = { 7515b2fc499SJeff Garzik .get_link = kaweth_get_link 7525b2fc499SJeff Garzik }; 7535b2fc499SJeff Garzik 7545b2fc499SJeff Garzik /**************************************************************** 7555b2fc499SJeff Garzik * kaweth_usb_transmit_complete 7565b2fc499SJeff Garzik ****************************************************************/ 7575b2fc499SJeff Garzik static void kaweth_usb_transmit_complete(struct urb *urb) 7585b2fc499SJeff Garzik { 7595b2fc499SJeff Garzik struct kaweth_device *kaweth = urb->context; 7605b2fc499SJeff Garzik struct sk_buff *skb = kaweth->tx_skb; 761c94cb314SOliver Neukum int status = urb->status; 7625b2fc499SJeff Garzik 763c94cb314SOliver Neukum if (unlikely(status != 0)) 764c94cb314SOliver Neukum if (status != -ENOENT) 76549ae25b0SGreg Kroah-Hartman dev_dbg(&urb->dev->dev, "%s: TX status %d.\n", 76649ae25b0SGreg Kroah-Hartman kaweth->net->name, status); 7675b2fc499SJeff Garzik 7685b2fc499SJeff Garzik netif_wake_queue(kaweth->net); 7695b2fc499SJeff Garzik dev_kfree_skb_irq(skb); 7705b2fc499SJeff Garzik } 7715b2fc499SJeff Garzik 7725b2fc499SJeff Garzik /**************************************************************** 7735b2fc499SJeff Garzik * kaweth_start_xmit 7745b2fc499SJeff Garzik ****************************************************************/ 77525a79c41SStephen Hemminger static netdev_tx_t kaweth_start_xmit(struct sk_buff *skb, 77625a79c41SStephen Hemminger struct net_device *net) 7775b2fc499SJeff Garzik { 7785b2fc499SJeff Garzik struct kaweth_device *kaweth = netdev_priv(net); 7795b2fc499SJeff Garzik __le16 *private_header; 7805b2fc499SJeff Garzik 7815b2fc499SJeff Garzik int res; 7825b2fc499SJeff Garzik 7834ff61c8fSLarry Finger spin_lock_irq(&kaweth->device_lock); 7845b2fc499SJeff Garzik 7855b2fc499SJeff Garzik kaweth_async_set_rx_mode(kaweth); 7865b2fc499SJeff Garzik netif_stop_queue(net); 7875b2fc499SJeff Garzik if (IS_BLOCKED(kaweth->status)) { 7885b2fc499SJeff Garzik goto skip; 7895b2fc499SJeff Garzik } 7905b2fc499SJeff Garzik 7915b2fc499SJeff Garzik /* We now decide whether we can put our special header into the sk_buff */ 79239fba783SEric Dumazet if (skb_cow_head(skb, 2)) { 7936ffa770eSTobias Klauser net->stats.tx_errors++; 7945b2fc499SJeff Garzik netif_start_queue(net); 7954ff61c8fSLarry Finger spin_unlock_irq(&kaweth->device_lock); 79639fba783SEric Dumazet dev_kfree_skb_any(skb); 7976ed10654SPatrick McHardy return NETDEV_TX_OK; 7985b2fc499SJeff Garzik } 7995b2fc499SJeff Garzik 800d58ff351SJohannes Berg private_header = __skb_push(skb, 2); 8015b2fc499SJeff Garzik *private_header = cpu_to_le16(skb->len-2); 8025b2fc499SJeff Garzik kaweth->tx_skb = skb; 8035b2fc499SJeff Garzik 8045b2fc499SJeff Garzik usb_fill_bulk_urb(kaweth->tx_urb, 8055b2fc499SJeff Garzik kaweth->dev, 8065b2fc499SJeff Garzik usb_sndbulkpipe(kaweth->dev, 2), 8075b2fc499SJeff Garzik private_header, 8085b2fc499SJeff Garzik skb->len, 8095b2fc499SJeff Garzik kaweth_usb_transmit_complete, 8105b2fc499SJeff Garzik kaweth); 8115b2fc499SJeff Garzik kaweth->end = 0; 8125b2fc499SJeff Garzik 8135b2fc499SJeff Garzik if((res = usb_submit_urb(kaweth->tx_urb, GFP_ATOMIC))) 8145b2fc499SJeff Garzik { 8154dc89948SGreg Kroah-Hartman dev_warn(&net->dev, "kaweth failed tx_urb %d\n", res); 8165b2fc499SJeff Garzik skip: 8176ffa770eSTobias Klauser net->stats.tx_errors++; 8185b2fc499SJeff Garzik 8195b2fc499SJeff Garzik netif_start_queue(net); 8205b2fc499SJeff Garzik dev_kfree_skb_irq(skb); 8215b2fc499SJeff Garzik } 8225b2fc499SJeff Garzik else 8235b2fc499SJeff Garzik { 8246ffa770eSTobias Klauser net->stats.tx_packets++; 8256ffa770eSTobias Klauser net->stats.tx_bytes += skb->len; 8265b2fc499SJeff Garzik } 8275b2fc499SJeff Garzik 8284ff61c8fSLarry Finger spin_unlock_irq(&kaweth->device_lock); 8295b2fc499SJeff Garzik 8306ed10654SPatrick McHardy return NETDEV_TX_OK; 8315b2fc499SJeff Garzik } 8325b2fc499SJeff Garzik 8335b2fc499SJeff Garzik /**************************************************************** 8345b2fc499SJeff Garzik * kaweth_set_rx_mode 8355b2fc499SJeff Garzik ****************************************************************/ 8365b2fc499SJeff Garzik static void kaweth_set_rx_mode(struct net_device *net) 8375b2fc499SJeff Garzik { 8385b2fc499SJeff Garzik struct kaweth_device *kaweth = netdev_priv(net); 8395b2fc499SJeff Garzik 8405b2fc499SJeff Garzik __u16 packet_filter_bitmap = KAWETH_PACKET_FILTER_DIRECTED | 8415b2fc499SJeff Garzik KAWETH_PACKET_FILTER_BROADCAST | 8425b2fc499SJeff Garzik KAWETH_PACKET_FILTER_MULTICAST; 8435b2fc499SJeff Garzik 84449ae25b0SGreg Kroah-Hartman netdev_dbg(net, "Setting Rx mode to %d\n", packet_filter_bitmap); 8455b2fc499SJeff Garzik 8465b2fc499SJeff Garzik netif_stop_queue(net); 8475b2fc499SJeff Garzik 8485b2fc499SJeff Garzik if (net->flags & IFF_PROMISC) { 8495b2fc499SJeff Garzik packet_filter_bitmap |= KAWETH_PACKET_FILTER_PROMISCUOUS; 8505b2fc499SJeff Garzik } 8514cd24eafSJiri Pirko else if (!netdev_mc_empty(net) || (net->flags & IFF_ALLMULTI)) { 8525b2fc499SJeff Garzik packet_filter_bitmap |= KAWETH_PACKET_FILTER_ALL_MULTICAST; 8535b2fc499SJeff Garzik } 8545b2fc499SJeff Garzik 8555b2fc499SJeff Garzik kaweth->packet_filter_bitmap = packet_filter_bitmap; 8565b2fc499SJeff Garzik netif_wake_queue(net); 8575b2fc499SJeff Garzik } 8585b2fc499SJeff Garzik 8595b2fc499SJeff Garzik /**************************************************************** 8605b2fc499SJeff Garzik * kaweth_async_set_rx_mode 8615b2fc499SJeff Garzik ****************************************************************/ 8625b2fc499SJeff Garzik static void kaweth_async_set_rx_mode(struct kaweth_device *kaweth) 8635b2fc499SJeff Garzik { 864710b523aSLarry Finger int result; 8655b2fc499SJeff Garzik __u16 packet_filter_bitmap = kaweth->packet_filter_bitmap; 866710b523aSLarry Finger 8675b2fc499SJeff Garzik kaweth->packet_filter_bitmap = 0; 8685b2fc499SJeff Garzik if (packet_filter_bitmap == 0) 8695b2fc499SJeff Garzik return; 8705b2fc499SJeff Garzik 871710b523aSLarry Finger if (in_interrupt()) 872710b523aSLarry Finger return; 873710b523aSLarry Finger 8745b2fc499SJeff Garzik result = kaweth_control(kaweth, 8755b2fc499SJeff Garzik usb_sndctrlpipe(kaweth->dev, 0), 8765b2fc499SJeff Garzik KAWETH_COMMAND_SET_PACKET_FILTER, 8775b2fc499SJeff Garzik USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE, 8785b2fc499SJeff Garzik packet_filter_bitmap, 8795b2fc499SJeff Garzik 0, 8805b2fc499SJeff Garzik (void *)&kaweth->scratch, 8815b2fc499SJeff Garzik 0, 8825b2fc499SJeff Garzik KAWETH_CONTROL_TIMEOUT); 8835b2fc499SJeff Garzik 8845b2fc499SJeff Garzik if(result < 0) { 885db6b2219SGreg Kroah-Hartman dev_err(&kaweth->intf->dev, "Failed to set Rx mode: %d\n", 886db6b2219SGreg Kroah-Hartman result); 8875b2fc499SJeff Garzik } 8885b2fc499SJeff Garzik else { 88949ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "Set Rx mode to %d\n", 89049ae25b0SGreg Kroah-Hartman packet_filter_bitmap); 8915b2fc499SJeff Garzik } 8925b2fc499SJeff Garzik } 8935b2fc499SJeff Garzik 8945b2fc499SJeff Garzik /**************************************************************** 8955b2fc499SJeff Garzik * kaweth_tx_timeout 8965b2fc499SJeff Garzik ****************************************************************/ 897*0290bd29SMichael S. Tsirkin static void kaweth_tx_timeout(struct net_device *net, unsigned int txqueue) 8985b2fc499SJeff Garzik { 8995b2fc499SJeff Garzik struct kaweth_device *kaweth = netdev_priv(net); 9005b2fc499SJeff Garzik 9014dc89948SGreg Kroah-Hartman dev_warn(&net->dev, "%s: Tx timed out. Resetting.\n", net->name); 9026ffa770eSTobias Klauser net->stats.tx_errors++; 903860e9538SFlorian Westphal netif_trans_update(net); 9045b2fc499SJeff Garzik 9055b2fc499SJeff Garzik usb_unlink_urb(kaweth->tx_urb); 9065b2fc499SJeff Garzik } 9075b2fc499SJeff Garzik 9085b2fc499SJeff Garzik /**************************************************************** 9095b2fc499SJeff Garzik * kaweth_suspend 9105b2fc499SJeff Garzik ****************************************************************/ 9115b2fc499SJeff Garzik static int kaweth_suspend(struct usb_interface *intf, pm_message_t message) 9125b2fc499SJeff Garzik { 9135b2fc499SJeff Garzik struct kaweth_device *kaweth = usb_get_intfdata(intf); 9145b2fc499SJeff Garzik unsigned long flags; 9155b2fc499SJeff Garzik 9165b2fc499SJeff Garzik spin_lock_irqsave(&kaweth->device_lock, flags); 9175b2fc499SJeff Garzik kaweth->status |= KAWETH_STATUS_SUSPENDING; 9185b2fc499SJeff Garzik spin_unlock_irqrestore(&kaweth->device_lock, flags); 9195b2fc499SJeff Garzik 9205b2fc499SJeff Garzik kaweth_kill_urbs(kaweth); 9215b2fc499SJeff Garzik return 0; 9225b2fc499SJeff Garzik } 9235b2fc499SJeff Garzik 9245b2fc499SJeff Garzik /**************************************************************** 9255b2fc499SJeff Garzik * kaweth_resume 9265b2fc499SJeff Garzik ****************************************************************/ 9275b2fc499SJeff Garzik static int kaweth_resume(struct usb_interface *intf) 9285b2fc499SJeff Garzik { 9295b2fc499SJeff Garzik struct kaweth_device *kaweth = usb_get_intfdata(intf); 9305b2fc499SJeff Garzik unsigned long flags; 9315b2fc499SJeff Garzik 9325b2fc499SJeff Garzik spin_lock_irqsave(&kaweth->device_lock, flags); 9335b2fc499SJeff Garzik kaweth->status &= ~KAWETH_STATUS_SUSPENDING; 9345b2fc499SJeff Garzik spin_unlock_irqrestore(&kaweth->device_lock, flags); 9355b2fc499SJeff Garzik 9365b2fc499SJeff Garzik if (!kaweth->opened) 9375b2fc499SJeff Garzik return 0; 9385b2fc499SJeff Garzik kaweth_resubmit_rx_urb(kaweth, GFP_NOIO); 9395b2fc499SJeff Garzik kaweth_resubmit_int_urb(kaweth, GFP_NOIO); 9405b2fc499SJeff Garzik 9415b2fc499SJeff Garzik return 0; 9425b2fc499SJeff Garzik } 9435b2fc499SJeff Garzik 9445b2fc499SJeff Garzik /**************************************************************** 9455b2fc499SJeff Garzik * kaweth_probe 9465b2fc499SJeff Garzik ****************************************************************/ 947321ea8b2SOliver Neukum 948321ea8b2SOliver Neukum 949321ea8b2SOliver Neukum static const struct net_device_ops kaweth_netdev_ops = { 950321ea8b2SOliver Neukum .ndo_open = kaweth_open, 951321ea8b2SOliver Neukum .ndo_stop = kaweth_close, 952321ea8b2SOliver Neukum .ndo_start_xmit = kaweth_start_xmit, 953321ea8b2SOliver Neukum .ndo_tx_timeout = kaweth_tx_timeout, 954afc4b13dSJiri Pirko .ndo_set_rx_mode = kaweth_set_rx_mode, 955240c102dSBen Hutchings .ndo_set_mac_address = eth_mac_addr, 956240c102dSBen Hutchings .ndo_validate_addr = eth_validate_addr, 957321ea8b2SOliver Neukum }; 958321ea8b2SOliver Neukum 9595b2fc499SJeff Garzik static int kaweth_probe( 9605b2fc499SJeff Garzik struct usb_interface *intf, 9615b2fc499SJeff Garzik const struct usb_device_id *id /* from id_table */ 9625b2fc499SJeff Garzik ) 9635b2fc499SJeff Garzik { 96449ae25b0SGreg Kroah-Hartman struct device *dev = &intf->dev; 96549ae25b0SGreg Kroah-Hartman struct usb_device *udev = interface_to_usbdev(intf); 9665b2fc499SJeff Garzik struct kaweth_device *kaweth; 9675b2fc499SJeff Garzik struct net_device *netdev; 9685b2fc499SJeff Garzik const eth_addr_t bcast_addr = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; 9695b2fc499SJeff Garzik int result = 0; 970575ced7fSOliver Neukum int rv = -EIO; 9715b2fc499SJeff Garzik 97249ae25b0SGreg Kroah-Hartman dev_dbg(dev, 97349ae25b0SGreg Kroah-Hartman "Kawasaki Device Probe (Device number:%d): 0x%4.4x:0x%4.4x:0x%4.4x\n", 97449ae25b0SGreg Kroah-Hartman udev->devnum, le16_to_cpu(udev->descriptor.idVendor), 97549ae25b0SGreg Kroah-Hartman le16_to_cpu(udev->descriptor.idProduct), 97649ae25b0SGreg Kroah-Hartman le16_to_cpu(udev->descriptor.bcdDevice)); 9775b2fc499SJeff Garzik 97849ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Device at %p\n", udev); 9795b2fc499SJeff Garzik 98049ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Descriptor length: %x type: %x\n", 98149ae25b0SGreg Kroah-Hartman (int)udev->descriptor.bLength, 98249ae25b0SGreg Kroah-Hartman (int)udev->descriptor.bDescriptorType); 9835b2fc499SJeff Garzik 9845b2fc499SJeff Garzik netdev = alloc_etherdev(sizeof(*kaweth)); 9855b2fc499SJeff Garzik if (!netdev) 9865b2fc499SJeff Garzik return -ENOMEM; 9875b2fc499SJeff Garzik 9885b2fc499SJeff Garzik kaweth = netdev_priv(netdev); 98949ae25b0SGreg Kroah-Hartman kaweth->dev = udev; 9905b2fc499SJeff Garzik kaweth->net = netdev; 99160bcabd0SOliver Neukum kaweth->intf = intf; 9925b2fc499SJeff Garzik 9935b2fc499SJeff Garzik spin_lock_init(&kaweth->device_lock); 9945b2fc499SJeff Garzik init_waitqueue_head(&kaweth->term_wait); 9955b2fc499SJeff Garzik 99649ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Resetting.\n"); 9975b2fc499SJeff Garzik 9985b2fc499SJeff Garzik kaweth_reset(kaweth); 9995b2fc499SJeff Garzik 10005b2fc499SJeff Garzik /* 10015b2fc499SJeff Garzik * If high byte of bcdDevice is nonzero, firmware is already 10025b2fc499SJeff Garzik * downloaded. Don't try to do it again, or we'll hang the device. 10035b2fc499SJeff Garzik */ 10045b2fc499SJeff Garzik 100549ae25b0SGreg Kroah-Hartman if (le16_to_cpu(udev->descriptor.bcdDevice) >> 8) { 100649ae25b0SGreg Kroah-Hartman dev_info(dev, "Firmware present in device.\n"); 10075b2fc499SJeff Garzik } else { 10085b2fc499SJeff Garzik /* Download the firmware */ 100949ae25b0SGreg Kroah-Hartman dev_info(dev, "Downloading firmware...\n"); 10105b2fc499SJeff Garzik kaweth->firmware_buf = (__u8 *)__get_free_page(GFP_KERNEL); 1011575ced7fSOliver Neukum if (!kaweth->firmware_buf) { 1012575ced7fSOliver Neukum rv = -ENOMEM; 1013575ced7fSOliver Neukum goto err_free_netdev; 1014575ced7fSOliver Neukum } 10155b2fc499SJeff Garzik if ((result = kaweth_download_firmware(kaweth, 101679682499SDavid Woodhouse "kaweth/new_code.bin", 10175b2fc499SJeff Garzik 100, 10185b2fc499SJeff Garzik 2)) < 0) { 101949ae25b0SGreg Kroah-Hartman dev_err(dev, "Error downloading firmware (%d)\n", 1020db6b2219SGreg Kroah-Hartman result); 10215b2fc499SJeff Garzik goto err_fw; 10225b2fc499SJeff Garzik } 10235b2fc499SJeff Garzik 10245b2fc499SJeff Garzik if ((result = kaweth_download_firmware(kaweth, 102579682499SDavid Woodhouse "kaweth/new_code_fix.bin", 10265b2fc499SJeff Garzik 100, 10275b2fc499SJeff Garzik 3)) < 0) { 102849ae25b0SGreg Kroah-Hartman dev_err(dev, "Error downloading firmware fix (%d)\n", 1029db6b2219SGreg Kroah-Hartman result); 10305b2fc499SJeff Garzik goto err_fw; 10315b2fc499SJeff Garzik } 10325b2fc499SJeff Garzik 10335b2fc499SJeff Garzik if ((result = kaweth_download_firmware(kaweth, 103479682499SDavid Woodhouse "kaweth/trigger_code.bin", 10355b2fc499SJeff Garzik 126, 10365b2fc499SJeff Garzik 2)) < 0) { 103749ae25b0SGreg Kroah-Hartman dev_err(dev, "Error downloading trigger code (%d)\n", 1038db6b2219SGreg Kroah-Hartman result); 10395b2fc499SJeff Garzik goto err_fw; 10405b2fc499SJeff Garzik 10415b2fc499SJeff Garzik } 10425b2fc499SJeff Garzik 10435b2fc499SJeff Garzik if ((result = kaweth_download_firmware(kaweth, 104479682499SDavid Woodhouse "kaweth/trigger_code_fix.bin", 10455b2fc499SJeff Garzik 126, 10465b2fc499SJeff Garzik 3)) < 0) { 104749ae25b0SGreg Kroah-Hartman dev_err(dev, "Error downloading trigger code fix (%d)\n", result); 10485b2fc499SJeff Garzik goto err_fw; 10495b2fc499SJeff Garzik } 10505b2fc499SJeff Garzik 10515b2fc499SJeff Garzik 10525b2fc499SJeff Garzik if ((result = kaweth_trigger_firmware(kaweth, 126)) < 0) { 105349ae25b0SGreg Kroah-Hartman dev_err(dev, "Error triggering firmware (%d)\n", result); 10545b2fc499SJeff Garzik goto err_fw; 10555b2fc499SJeff Garzik } 10565b2fc499SJeff Garzik 10575b2fc499SJeff Garzik /* Device will now disappear for a moment... */ 105849ae25b0SGreg Kroah-Hartman dev_info(dev, "Firmware loaded. I'll be back...\n"); 10595b2fc499SJeff Garzik err_fw: 10605b2fc499SJeff Garzik free_page((unsigned long)kaweth->firmware_buf); 10615b2fc499SJeff Garzik free_netdev(netdev); 10625b2fc499SJeff Garzik return -EIO; 10635b2fc499SJeff Garzik } 10645b2fc499SJeff Garzik 10655b2fc499SJeff Garzik result = kaweth_read_configuration(kaweth); 10665b2fc499SJeff Garzik 10675b2fc499SJeff Garzik if(result < 0) { 106849ae25b0SGreg Kroah-Hartman dev_err(dev, "Error reading configuration (%d), no net device created\n", result); 10695b2fc499SJeff Garzik goto err_free_netdev; 10705b2fc499SJeff Garzik } 10715b2fc499SJeff Garzik 107249ae25b0SGreg Kroah-Hartman dev_info(dev, "Statistics collection: %x\n", kaweth->configuration.statistics_mask); 107349ae25b0SGreg Kroah-Hartman dev_info(dev, "Multicast filter limit: %x\n", kaweth->configuration.max_multicast_filters & ((1 << 15) - 1)); 107449ae25b0SGreg Kroah-Hartman dev_info(dev, "MTU: %d\n", le16_to_cpu(kaweth->configuration.segment_size)); 107549ae25b0SGreg Kroah-Hartman dev_info(dev, "Read MAC address %pM\n", kaweth->configuration.hw_addr); 10765b2fc499SJeff Garzik 10775b2fc499SJeff Garzik if(!memcmp(&kaweth->configuration.hw_addr, 10785b2fc499SJeff Garzik &bcast_addr, 10795b2fc499SJeff Garzik sizeof(bcast_addr))) { 108049ae25b0SGreg Kroah-Hartman dev_err(dev, "Firmware not functioning properly, no net device created\n"); 10815b2fc499SJeff Garzik goto err_free_netdev; 10825b2fc499SJeff Garzik } 10835b2fc499SJeff Garzik 10845b2fc499SJeff Garzik if(kaweth_set_urb_size(kaweth, KAWETH_BUF_SIZE) < 0) { 108549ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Error setting URB size\n"); 10865b2fc499SJeff Garzik goto err_free_netdev; 10875b2fc499SJeff Garzik } 10885b2fc499SJeff Garzik 10895b2fc499SJeff Garzik if(kaweth_set_sofs_wait(kaweth, KAWETH_SOFS_TO_WAIT) < 0) { 109049ae25b0SGreg Kroah-Hartman dev_err(dev, "Error setting SOFS wait\n"); 10915b2fc499SJeff Garzik goto err_free_netdev; 10925b2fc499SJeff Garzik } 10935b2fc499SJeff Garzik 10945b2fc499SJeff Garzik result = kaweth_set_receive_filter(kaweth, 10955b2fc499SJeff Garzik KAWETH_PACKET_FILTER_DIRECTED | 10965b2fc499SJeff Garzik KAWETH_PACKET_FILTER_BROADCAST | 10975b2fc499SJeff Garzik KAWETH_PACKET_FILTER_MULTICAST); 10985b2fc499SJeff Garzik 10995b2fc499SJeff Garzik if(result < 0) { 110049ae25b0SGreg Kroah-Hartman dev_err(dev, "Error setting receive filter\n"); 11015b2fc499SJeff Garzik goto err_free_netdev; 11025b2fc499SJeff Garzik } 11035b2fc499SJeff Garzik 110449ae25b0SGreg Kroah-Hartman dev_dbg(dev, "Initializing net device.\n"); 11055b2fc499SJeff Garzik 11065b2fc499SJeff Garzik kaweth->tx_urb = usb_alloc_urb(0, GFP_KERNEL); 11075b2fc499SJeff Garzik if (!kaweth->tx_urb) 11085b2fc499SJeff Garzik goto err_free_netdev; 11095b2fc499SJeff Garzik kaweth->rx_urb = usb_alloc_urb(0, GFP_KERNEL); 11105b2fc499SJeff Garzik if (!kaweth->rx_urb) 11115b2fc499SJeff Garzik goto err_only_tx; 11125b2fc499SJeff Garzik kaweth->irq_urb = usb_alloc_urb(0, GFP_KERNEL); 11135b2fc499SJeff Garzik if (!kaweth->irq_urb) 11145b2fc499SJeff Garzik goto err_tx_and_rx; 11155b2fc499SJeff Garzik 1116997ea58eSDaniel Mack kaweth->intbuffer = usb_alloc_coherent( kaweth->dev, 11175b2fc499SJeff Garzik INTBUFFERSIZE, 11185b2fc499SJeff Garzik GFP_KERNEL, 11195b2fc499SJeff Garzik &kaweth->intbufferhandle); 11205b2fc499SJeff Garzik if (!kaweth->intbuffer) 11215b2fc499SJeff Garzik goto err_tx_and_rx_and_irq; 1122997ea58eSDaniel Mack kaweth->rx_buf = usb_alloc_coherent( kaweth->dev, 11235b2fc499SJeff Garzik KAWETH_BUF_SIZE, 11245b2fc499SJeff Garzik GFP_KERNEL, 11255b2fc499SJeff Garzik &kaweth->rxbufferhandle); 11265b2fc499SJeff Garzik if (!kaweth->rx_buf) 11275b2fc499SJeff Garzik goto err_all_but_rxbuf; 11285b2fc499SJeff Garzik 11295b2fc499SJeff Garzik memcpy(netdev->broadcast, &bcast_addr, sizeof(bcast_addr)); 11305b2fc499SJeff Garzik memcpy(netdev->dev_addr, &kaweth->configuration.hw_addr, 11315b2fc499SJeff Garzik sizeof(kaweth->configuration.hw_addr)); 11325b2fc499SJeff Garzik 1133321ea8b2SOliver Neukum netdev->netdev_ops = &kaweth_netdev_ops; 11345b2fc499SJeff Garzik netdev->watchdog_timeo = KAWETH_TX_TIMEOUT; 11355b2fc499SJeff Garzik netdev->mtu = le16_to_cpu(kaweth->configuration.segment_size); 11367ad24ea4SWilfried Klaebe netdev->ethtool_ops = &ops; 11375b2fc499SJeff Garzik 11385b2fc499SJeff Garzik /* kaweth is zeroed as part of alloc_netdev */ 11395b2fc499SJeff Garzik INIT_DELAYED_WORK(&kaweth->lowmem_work, kaweth_resubmit_tl); 11405b2fc499SJeff Garzik usb_set_intfdata(intf, kaweth); 11415b2fc499SJeff Garzik 114249ae25b0SGreg Kroah-Hartman SET_NETDEV_DEV(netdev, dev); 11435b2fc499SJeff Garzik if (register_netdev(netdev) != 0) { 114449ae25b0SGreg Kroah-Hartman dev_err(dev, "Error registering netdev.\n"); 11455b2fc499SJeff Garzik goto err_intfdata; 11465b2fc499SJeff Garzik } 11475b2fc499SJeff Garzik 114849ae25b0SGreg Kroah-Hartman dev_info(dev, "kaweth interface created at %s\n", 1149880c9c66SGreg Kroah-Hartman kaweth->net->name); 11505b2fc499SJeff Garzik 11515b2fc499SJeff Garzik return 0; 11525b2fc499SJeff Garzik 11535b2fc499SJeff Garzik err_intfdata: 11545b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 1155997ea58eSDaniel Mack usb_free_coherent(kaweth->dev, KAWETH_BUF_SIZE, (void *)kaweth->rx_buf, kaweth->rxbufferhandle); 11565b2fc499SJeff Garzik err_all_but_rxbuf: 1157997ea58eSDaniel Mack usb_free_coherent(kaweth->dev, INTBUFFERSIZE, (void *)kaweth->intbuffer, kaweth->intbufferhandle); 11585b2fc499SJeff Garzik err_tx_and_rx_and_irq: 11595b2fc499SJeff Garzik usb_free_urb(kaweth->irq_urb); 11605b2fc499SJeff Garzik err_tx_and_rx: 11615b2fc499SJeff Garzik usb_free_urb(kaweth->rx_urb); 11625b2fc499SJeff Garzik err_only_tx: 11635b2fc499SJeff Garzik usb_free_urb(kaweth->tx_urb); 11645b2fc499SJeff Garzik err_free_netdev: 11655b2fc499SJeff Garzik free_netdev(netdev); 11665b2fc499SJeff Garzik 1167575ced7fSOliver Neukum return rv; 11685b2fc499SJeff Garzik } 11695b2fc499SJeff Garzik 11705b2fc499SJeff Garzik /**************************************************************** 11715b2fc499SJeff Garzik * kaweth_disconnect 11725b2fc499SJeff Garzik ****************************************************************/ 11735b2fc499SJeff Garzik static void kaweth_disconnect(struct usb_interface *intf) 11745b2fc499SJeff Garzik { 11755b2fc499SJeff Garzik struct kaweth_device *kaweth = usb_get_intfdata(intf); 11765b2fc499SJeff Garzik struct net_device *netdev; 11775b2fc499SJeff Garzik 11785b2fc499SJeff Garzik usb_set_intfdata(intf, NULL); 11795b2fc499SJeff Garzik if (!kaweth) { 118025985edcSLucas De Marchi dev_warn(&intf->dev, "unregistering non-existent device\n"); 11815b2fc499SJeff Garzik return; 11825b2fc499SJeff Garzik } 11835b2fc499SJeff Garzik netdev = kaweth->net; 11845b2fc499SJeff Garzik 118549ae25b0SGreg Kroah-Hartman netdev_dbg(kaweth->net, "Unregistering net device\n"); 11865b2fc499SJeff Garzik unregister_netdev(netdev); 11875b2fc499SJeff Garzik 11885b2fc499SJeff Garzik usb_free_urb(kaweth->rx_urb); 11895b2fc499SJeff Garzik usb_free_urb(kaweth->tx_urb); 11905b2fc499SJeff Garzik usb_free_urb(kaweth->irq_urb); 11915b2fc499SJeff Garzik 1192997ea58eSDaniel Mack usb_free_coherent(kaweth->dev, KAWETH_BUF_SIZE, (void *)kaweth->rx_buf, kaweth->rxbufferhandle); 1193997ea58eSDaniel Mack usb_free_coherent(kaweth->dev, INTBUFFERSIZE, (void *)kaweth->intbuffer, kaweth->intbufferhandle); 11945b2fc499SJeff Garzik 11955b2fc499SJeff Garzik free_netdev(netdev); 11965b2fc499SJeff Garzik } 11975b2fc499SJeff Garzik 11985b2fc499SJeff Garzik 11995b2fc499SJeff Garzik // FIXME this completion stuff is a modified clone of 12005b2fc499SJeff Garzik // an OLD version of some stuff in usb.c ... 12015b2fc499SJeff Garzik struct usb_api_data { 12025b2fc499SJeff Garzik wait_queue_head_t wqh; 12035b2fc499SJeff Garzik int done; 12045b2fc499SJeff Garzik }; 12055b2fc499SJeff Garzik 12065b2fc499SJeff Garzik /*-------------------------------------------------------------------* 12075b2fc499SJeff Garzik * completion handler for compatibility wrappers (sync control/bulk) * 12085b2fc499SJeff Garzik *-------------------------------------------------------------------*/ 12095b2fc499SJeff Garzik static void usb_api_blocking_completion(struct urb *urb) 12105b2fc499SJeff Garzik { 12115b2fc499SJeff Garzik struct usb_api_data *awd = (struct usb_api_data *)urb->context; 12125b2fc499SJeff Garzik 12135b2fc499SJeff Garzik awd->done=1; 12145b2fc499SJeff Garzik wake_up(&awd->wqh); 12155b2fc499SJeff Garzik } 12165b2fc499SJeff Garzik 12175b2fc499SJeff Garzik /*-------------------------------------------------------------------* 12185b2fc499SJeff Garzik * COMPATIBILITY STUFF * 12195b2fc499SJeff Garzik *-------------------------------------------------------------------*/ 12205b2fc499SJeff Garzik 12215b2fc499SJeff Garzik // Starts urb and waits for completion or timeout 12225b2fc499SJeff Garzik static int usb_start_wait_urb(struct urb *urb, int timeout, int* actual_length) 12235b2fc499SJeff Garzik { 12245b2fc499SJeff Garzik struct usb_api_data awd; 12255b2fc499SJeff Garzik int status; 12265b2fc499SJeff Garzik 12275b2fc499SJeff Garzik init_waitqueue_head(&awd.wqh); 12285b2fc499SJeff Garzik awd.done = 0; 12295b2fc499SJeff Garzik 12305b2fc499SJeff Garzik urb->context = &awd; 123149c9e7c2SAlexey Khoroshilov status = usb_submit_urb(urb, GFP_ATOMIC); 12325b2fc499SJeff Garzik if (status) { 12335b2fc499SJeff Garzik // something went wrong 12345b2fc499SJeff Garzik usb_free_urb(urb); 12355b2fc499SJeff Garzik return status; 12365b2fc499SJeff Garzik } 12375b2fc499SJeff Garzik 12385b2fc499SJeff Garzik if (!wait_event_timeout(awd.wqh, awd.done, timeout)) { 12395b2fc499SJeff Garzik // timeout 12404dc89948SGreg Kroah-Hartman dev_warn(&urb->dev->dev, "usb_control/bulk_msg: timeout\n"); 12415b2fc499SJeff Garzik usb_kill_urb(urb); // remove urb safely 12425b2fc499SJeff Garzik status = -ETIMEDOUT; 12435b2fc499SJeff Garzik } 12445b2fc499SJeff Garzik else { 12455b2fc499SJeff Garzik status = urb->status; 12465b2fc499SJeff Garzik } 12475b2fc499SJeff Garzik 12485b2fc499SJeff Garzik if (actual_length) { 12495b2fc499SJeff Garzik *actual_length = urb->actual_length; 12505b2fc499SJeff Garzik } 12515b2fc499SJeff Garzik 12525b2fc499SJeff Garzik usb_free_urb(urb); 12535b2fc499SJeff Garzik return status; 12545b2fc499SJeff Garzik } 12555b2fc499SJeff Garzik 12565b2fc499SJeff Garzik /*-------------------------------------------------------------------*/ 12575b2fc499SJeff Garzik // returns status (negative) or length (positive) 12585b2fc499SJeff Garzik static int kaweth_internal_control_msg(struct usb_device *usb_dev, 12595b2fc499SJeff Garzik unsigned int pipe, 12605b2fc499SJeff Garzik struct usb_ctrlrequest *cmd, void *data, 12615b2fc499SJeff Garzik int len, int timeout) 12625b2fc499SJeff Garzik { 12635b2fc499SJeff Garzik struct urb *urb; 12645b2fc499SJeff Garzik int retv; 12655b2fc499SJeff Garzik int length = 0; /* shut up GCC */ 12665b2fc499SJeff Garzik 1267e4c7f259SDan Carpenter urb = usb_alloc_urb(0, GFP_ATOMIC); 12685b2fc499SJeff Garzik if (!urb) 12695b2fc499SJeff Garzik return -ENOMEM; 12705b2fc499SJeff Garzik 12715b2fc499SJeff Garzik usb_fill_control_urb(urb, usb_dev, pipe, (unsigned char*)cmd, data, 12725b2fc499SJeff Garzik len, usb_api_blocking_completion, NULL); 12735b2fc499SJeff Garzik 12745b2fc499SJeff Garzik retv = usb_start_wait_urb(urb, timeout, &length); 12755b2fc499SJeff Garzik if (retv < 0) { 12765b2fc499SJeff Garzik return retv; 12775b2fc499SJeff Garzik } 12785b2fc499SJeff Garzik else { 12795b2fc499SJeff Garzik return length; 12805b2fc499SJeff Garzik } 12815b2fc499SJeff Garzik } 12825b2fc499SJeff Garzik 1283d632eb1bSGreg Kroah-Hartman module_usb_driver(kaweth_driver); 1284