Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2001 Vojtech Pavlik |
| 3 | * |
| 4 | * CATC EL1210A NetMate USB Ethernet driver |
| 5 | * |
| 6 | * Sponsored by SuSE |
| 7 | * |
| 8 | * Based on the work of |
| 9 | * Donald Becker |
| 10 | * |
| 11 | * Old chipset support added by Simon Evans <spse@secret.org.uk> 2002 |
| 12 | * - adds support for Belkin F5U011 |
| 13 | */ |
| 14 | |
| 15 | /* |
| 16 | * This program is free software; you can redistribute it and/or modify |
| 17 | * it under the terms of the GNU General Public License as published by |
| 18 | * the Free Software Foundation; either version 2 of the License, or |
| 19 | * (at your option) any later version. |
| 20 | * |
| 21 | * This program is distributed in the hope that it will be useful, |
| 22 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 23 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 24 | * GNU General Public License for more details. |
| 25 | * |
| 26 | * You should have received a copy of the GNU General Public License |
| 27 | * along with this program; if not, write to the Free Software |
| 28 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 29 | * |
| 30 | * Should you need to contact me, the author, you can do so either by |
| 31 | * e-mail - mail your message to <vojtech@suse.cz>, or by paper mail: |
| 32 | * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic |
| 33 | */ |
| 34 | |
| 35 | #include <linux/init.h> |
| 36 | #include <linux/module.h> |
| 37 | #include <linux/kernel.h> |
| 38 | #include <linux/string.h> |
| 39 | #include <linux/slab.h> |
| 40 | #include <linux/netdevice.h> |
| 41 | #include <linux/etherdevice.h> |
| 42 | #include <linux/skbuff.h> |
| 43 | #include <linux/spinlock.h> |
| 44 | #include <linux/ethtool.h> |
| 45 | #include <linux/crc32.h> |
| 46 | #include <linux/bitops.h> |
| 47 | #include <asm/uaccess.h> |
| 48 | |
| 49 | #undef DEBUG |
| 50 | |
| 51 | #include <linux/usb.h> |
| 52 | |
| 53 | /* |
| 54 | * Version information. |
| 55 | */ |
| 56 | |
| 57 | #define DRIVER_VERSION "v2.8" |
| 58 | #define DRIVER_AUTHOR "Vojtech Pavlik <vojtech@suse.cz>" |
| 59 | #define DRIVER_DESC "CATC EL1210A NetMate USB Ethernet driver" |
| 60 | #define SHORT_DRIVER_DESC "EL1210A NetMate USB Ethernet" |
| 61 | |
| 62 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 63 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 64 | MODULE_LICENSE("GPL"); |
| 65 | |
| 66 | static const char driver_name[] = "catc"; |
| 67 | |
| 68 | /* |
| 69 | * Some defines. |
| 70 | */ |
| 71 | |
| 72 | #define STATS_UPDATE (HZ) /* Time between stats updates */ |
| 73 | #define TX_TIMEOUT (5*HZ) /* Max time the queue can be stopped */ |
| 74 | #define PKT_SZ 1536 /* Max Ethernet packet size */ |
| 75 | #define RX_MAX_BURST 15 /* Max packets per rx buffer (> 0, < 16) */ |
| 76 | #define TX_MAX_BURST 15 /* Max full sized packets per tx buffer (> 0) */ |
| 77 | #define CTRL_QUEUE 16 /* Max control requests in flight (power of two) */ |
| 78 | #define RX_PKT_SZ 1600 /* Max size of receive packet for F5U011 */ |
| 79 | |
| 80 | /* |
| 81 | * Control requests. |
| 82 | */ |
| 83 | |
| 84 | enum control_requests { |
| 85 | ReadMem = 0xf1, |
| 86 | GetMac = 0xf2, |
| 87 | Reset = 0xf4, |
| 88 | SetMac = 0xf5, |
| 89 | SetRxMode = 0xf5, /* F5U011 only */ |
| 90 | WriteROM = 0xf8, |
| 91 | SetReg = 0xfa, |
| 92 | GetReg = 0xfb, |
| 93 | WriteMem = 0xfc, |
| 94 | ReadROM = 0xfd, |
| 95 | }; |
| 96 | |
| 97 | /* |
| 98 | * Registers. |
| 99 | */ |
| 100 | |
| 101 | enum register_offsets { |
| 102 | TxBufCount = 0x20, |
| 103 | RxBufCount = 0x21, |
| 104 | OpModes = 0x22, |
| 105 | TxQed = 0x23, |
| 106 | RxQed = 0x24, |
| 107 | MaxBurst = 0x25, |
| 108 | RxUnit = 0x60, |
| 109 | EthStatus = 0x61, |
| 110 | StationAddr0 = 0x67, |
| 111 | EthStats = 0x69, |
| 112 | LEDCtrl = 0x81, |
| 113 | }; |
| 114 | |
| 115 | enum eth_stats { |
| 116 | TxSingleColl = 0x00, |
| 117 | TxMultiColl = 0x02, |
| 118 | TxExcessColl = 0x04, |
| 119 | RxFramErr = 0x06, |
| 120 | }; |
| 121 | |
| 122 | enum op_mode_bits { |
| 123 | Op3MemWaits = 0x03, |
| 124 | OpLenInclude = 0x08, |
| 125 | OpRxMerge = 0x10, |
| 126 | OpTxMerge = 0x20, |
| 127 | OpWin95bugfix = 0x40, |
| 128 | OpLoopback = 0x80, |
| 129 | }; |
| 130 | |
| 131 | enum rx_filter_bits { |
| 132 | RxEnable = 0x01, |
| 133 | RxPolarity = 0x02, |
| 134 | RxForceOK = 0x04, |
| 135 | RxMultiCast = 0x08, |
| 136 | RxPromisc = 0x10, |
| 137 | AltRxPromisc = 0x20, /* F5U011 uses different bit */ |
| 138 | }; |
| 139 | |
| 140 | enum led_values { |
| 141 | LEDFast = 0x01, |
| 142 | LEDSlow = 0x02, |
| 143 | LEDFlash = 0x03, |
| 144 | LEDPulse = 0x04, |
| 145 | LEDLink = 0x08, |
| 146 | }; |
| 147 | |
| 148 | enum link_status { |
| 149 | LinkNoChange = 0, |
| 150 | LinkGood = 1, |
| 151 | LinkBad = 2 |
| 152 | }; |
| 153 | |
| 154 | /* |
| 155 | * The catc struct. |
| 156 | */ |
| 157 | |
| 158 | #define CTRL_RUNNING 0 |
| 159 | #define RX_RUNNING 1 |
| 160 | #define TX_RUNNING 2 |
| 161 | |
| 162 | struct catc { |
| 163 | struct net_device *netdev; |
| 164 | struct usb_device *usbdev; |
| 165 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | unsigned long flags; |
| 167 | |
| 168 | unsigned int tx_ptr, tx_idx; |
| 169 | unsigned int ctrl_head, ctrl_tail; |
| 170 | spinlock_t tx_lock, ctrl_lock; |
| 171 | |
| 172 | u8 tx_buf[2][TX_MAX_BURST * (PKT_SZ + 2)]; |
| 173 | u8 rx_buf[RX_MAX_BURST * (PKT_SZ + 2)]; |
| 174 | u8 irq_buf[2]; |
| 175 | u8 ctrl_buf[64]; |
| 176 | struct usb_ctrlrequest ctrl_dr; |
| 177 | |
| 178 | struct timer_list timer; |
| 179 | u8 stats_buf[8]; |
| 180 | u16 stats_vals[4]; |
| 181 | unsigned long last_stats; |
| 182 | |
| 183 | u8 multicast[64]; |
| 184 | |
| 185 | struct ctrl_queue { |
| 186 | u8 dir; |
| 187 | u8 request; |
| 188 | u16 value; |
| 189 | u16 index; |
| 190 | void *buf; |
| 191 | int len; |
| 192 | void (*callback)(struct catc *catc, struct ctrl_queue *q); |
| 193 | } ctrl_queue[CTRL_QUEUE]; |
| 194 | |
| 195 | struct urb *tx_urb, *rx_urb, *irq_urb, *ctrl_urb; |
| 196 | |
| 197 | u8 is_f5u011; /* Set if device is an F5U011 */ |
| 198 | u8 rxmode[2]; /* Used for F5U011 */ |
| 199 | atomic_t recq_sz; /* Used for F5U011 - counter of waiting rx packets */ |
| 200 | }; |
| 201 | |
| 202 | /* |
| 203 | * Useful macros. |
| 204 | */ |
| 205 | |
| 206 | #define catc_get_mac(catc, mac) catc_ctrl_msg(catc, USB_DIR_IN, GetMac, 0, 0, mac, 6) |
| 207 | #define catc_reset(catc) catc_ctrl_msg(catc, USB_DIR_OUT, Reset, 0, 0, NULL, 0) |
| 208 | #define catc_set_reg(catc, reg, val) catc_ctrl_msg(catc, USB_DIR_OUT, SetReg, val, reg, NULL, 0) |
| 209 | #define catc_get_reg(catc, reg, buf) catc_ctrl_msg(catc, USB_DIR_IN, GetReg, 0, reg, buf, 1) |
| 210 | #define catc_write_mem(catc, addr, buf, size) catc_ctrl_msg(catc, USB_DIR_OUT, WriteMem, 0, addr, buf, size) |
| 211 | #define catc_read_mem(catc, addr, buf, size) catc_ctrl_msg(catc, USB_DIR_IN, ReadMem, 0, addr, buf, size) |
| 212 | |
| 213 | #define f5u011_rxmode(catc, rxmode) catc_ctrl_msg(catc, USB_DIR_OUT, SetRxMode, 0, 1, rxmode, 2) |
| 214 | #define f5u011_rxmode_async(catc, rxmode) catc_ctrl_async(catc, USB_DIR_OUT, SetRxMode, 0, 1, &rxmode, 2, NULL) |
| 215 | #define f5u011_mchash_async(catc, hash) catc_ctrl_async(catc, USB_DIR_OUT, SetRxMode, 0, 2, &hash, 8, NULL) |
| 216 | |
| 217 | #define catc_set_reg_async(catc, reg, val) catc_ctrl_async(catc, USB_DIR_OUT, SetReg, val, reg, NULL, 0, NULL) |
| 218 | #define catc_get_reg_async(catc, reg, cb) catc_ctrl_async(catc, USB_DIR_IN, GetReg, 0, reg, NULL, 1, cb) |
| 219 | #define catc_write_mem_async(catc, addr, buf, size) catc_ctrl_async(catc, USB_DIR_OUT, WriteMem, 0, addr, buf, size, NULL) |
| 220 | |
| 221 | /* |
| 222 | * Receive routines. |
| 223 | */ |
| 224 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 225 | static void catc_rx_done(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 226 | { |
| 227 | struct catc *catc = urb->context; |
| 228 | u8 *pkt_start = urb->transfer_buffer; |
| 229 | struct sk_buff *skb; |
| 230 | int pkt_len, pkt_offset = 0; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 231 | int status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | |
| 233 | if (!catc->is_f5u011) { |
| 234 | clear_bit(RX_RUNNING, &catc->flags); |
| 235 | pkt_offset = 2; |
| 236 | } |
| 237 | |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 238 | if (status) { |
| 239 | dbg("rx_done, status %d, length %d", status, urb->actual_length); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 240 | return; |
| 241 | } |
| 242 | |
| 243 | do { |
| 244 | if(!catc->is_f5u011) { |
| 245 | pkt_len = le16_to_cpup((__le16*)pkt_start); |
| 246 | if (pkt_len > urb->actual_length) { |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 247 | catc->netdev->stats.rx_length_errors++; |
| 248 | catc->netdev->stats.rx_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 249 | break; |
| 250 | } |
| 251 | } else { |
| 252 | pkt_len = urb->actual_length; |
| 253 | } |
| 254 | |
| 255 | if (!(skb = dev_alloc_skb(pkt_len))) |
| 256 | return; |
| 257 | |
David S. Miller | 8c7b7fa | 2007-07-10 22:08:12 -0700 | [diff] [blame] | 258 | skb_copy_to_linear_data(skb, pkt_start + pkt_offset, pkt_len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 | skb_put(skb, pkt_len); |
| 260 | |
| 261 | skb->protocol = eth_type_trans(skb, catc->netdev); |
| 262 | netif_rx(skb); |
| 263 | |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 264 | catc->netdev->stats.rx_packets++; |
| 265 | catc->netdev->stats.rx_bytes += pkt_len; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 266 | |
| 267 | /* F5U011 only does one packet per RX */ |
| 268 | if (catc->is_f5u011) |
| 269 | break; |
| 270 | pkt_start += (((pkt_len + 1) >> 6) + 1) << 6; |
| 271 | |
| 272 | } while (pkt_start - (u8 *) urb->transfer_buffer < urb->actual_length); |
| 273 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 274 | if (catc->is_f5u011) { |
| 275 | if (atomic_read(&catc->recq_sz)) { |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 276 | int state; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 277 | atomic_dec(&catc->recq_sz); |
| 278 | dbg("getting extra packet"); |
| 279 | urb->dev = catc->usbdev; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 280 | if ((state = usb_submit_urb(urb, GFP_ATOMIC)) < 0) { |
| 281 | dbg("submit(rx_urb) status %d", state); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 282 | } |
| 283 | } else { |
| 284 | clear_bit(RX_RUNNING, &catc->flags); |
| 285 | } |
| 286 | } |
| 287 | } |
| 288 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 289 | static void catc_irq_done(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 290 | { |
| 291 | struct catc *catc = urb->context; |
| 292 | u8 *data = urb->transfer_buffer; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 293 | int status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | unsigned int hasdata = 0, linksts = LinkNoChange; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 295 | int res; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | |
| 297 | if (!catc->is_f5u011) { |
| 298 | hasdata = data[1] & 0x80; |
| 299 | if (data[1] & 0x40) |
| 300 | linksts = LinkGood; |
| 301 | else if (data[1] & 0x20) |
| 302 | linksts = LinkBad; |
| 303 | } else { |
| 304 | hasdata = (unsigned int)(be16_to_cpup((__be16*)data) & 0x0fff); |
| 305 | if (data[0] == 0x90) |
| 306 | linksts = LinkGood; |
| 307 | else if (data[0] == 0xA0) |
| 308 | linksts = LinkBad; |
| 309 | } |
| 310 | |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 311 | switch (status) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 312 | case 0: /* success */ |
| 313 | break; |
| 314 | case -ECONNRESET: /* unlink */ |
| 315 | case -ENOENT: |
| 316 | case -ESHUTDOWN: |
| 317 | return; |
| 318 | /* -EPIPE: should clear the halt */ |
| 319 | default: /* error */ |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 320 | dbg("irq_done, status %d, data %02x %02x.", status, data[0], data[1]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | goto resubmit; |
| 322 | } |
| 323 | |
| 324 | if (linksts == LinkGood) { |
| 325 | netif_carrier_on(catc->netdev); |
| 326 | dbg("link ok"); |
| 327 | } |
| 328 | |
| 329 | if (linksts == LinkBad) { |
| 330 | netif_carrier_off(catc->netdev); |
| 331 | dbg("link bad"); |
| 332 | } |
| 333 | |
| 334 | if (hasdata) { |
| 335 | if (test_and_set_bit(RX_RUNNING, &catc->flags)) { |
| 336 | if (catc->is_f5u011) |
| 337 | atomic_inc(&catc->recq_sz); |
| 338 | } else { |
| 339 | catc->rx_urb->dev = catc->usbdev; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 340 | if ((res = usb_submit_urb(catc->rx_urb, GFP_ATOMIC)) < 0) { |
| 341 | err("submit(rx_urb) status %d", res); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | } |
| 343 | } |
| 344 | } |
| 345 | resubmit: |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 346 | res = usb_submit_urb (urb, GFP_ATOMIC); |
| 347 | if (res) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | err ("can't resubmit intr, %s-%s, status %d", |
| 349 | catc->usbdev->bus->bus_name, |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 350 | catc->usbdev->devpath, res); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 351 | } |
| 352 | |
| 353 | /* |
| 354 | * Transmit routines. |
| 355 | */ |
| 356 | |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 357 | static int catc_tx_run(struct catc *catc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 358 | { |
| 359 | int status; |
| 360 | |
| 361 | if (catc->is_f5u011) |
| 362 | catc->tx_ptr = (catc->tx_ptr + 63) & ~63; |
| 363 | |
| 364 | catc->tx_urb->transfer_buffer_length = catc->tx_ptr; |
| 365 | catc->tx_urb->transfer_buffer = catc->tx_buf[catc->tx_idx]; |
| 366 | catc->tx_urb->dev = catc->usbdev; |
| 367 | |
| 368 | if ((status = usb_submit_urb(catc->tx_urb, GFP_ATOMIC)) < 0) |
| 369 | err("submit(tx_urb), status %d", status); |
| 370 | |
| 371 | catc->tx_idx = !catc->tx_idx; |
| 372 | catc->tx_ptr = 0; |
| 373 | |
| 374 | catc->netdev->trans_start = jiffies; |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 375 | return status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 | } |
| 377 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 378 | static void catc_tx_done(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 379 | { |
| 380 | struct catc *catc = urb->context; |
| 381 | unsigned long flags; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 382 | int r, status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 384 | if (status == -ECONNRESET) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 385 | dbg("Tx Reset."); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 386 | urb->status = 0; |
| 387 | catc->netdev->trans_start = jiffies; |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 388 | catc->netdev->stats.tx_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 389 | clear_bit(TX_RUNNING, &catc->flags); |
| 390 | netif_wake_queue(catc->netdev); |
| 391 | return; |
| 392 | } |
| 393 | |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 394 | if (status) { |
| 395 | dbg("tx_done, status %d, length %d", status, urb->actual_length); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 396 | return; |
| 397 | } |
| 398 | |
| 399 | spin_lock_irqsave(&catc->tx_lock, flags); |
| 400 | |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 401 | if (catc->tx_ptr) { |
| 402 | r = catc_tx_run(catc); |
| 403 | if (unlikely(r < 0)) |
| 404 | clear_bit(TX_RUNNING, &catc->flags); |
| 405 | } else { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 406 | clear_bit(TX_RUNNING, &catc->flags); |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 407 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 | |
| 409 | netif_wake_queue(catc->netdev); |
| 410 | |
| 411 | spin_unlock_irqrestore(&catc->tx_lock, flags); |
| 412 | } |
| 413 | |
Stephen Hemminger | 25a79c4 | 2009-08-31 19:50:45 +0000 | [diff] [blame] | 414 | static netdev_tx_t catc_start_xmit(struct sk_buff *skb, |
| 415 | struct net_device *netdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 416 | { |
| 417 | struct catc *catc = netdev_priv(netdev); |
| 418 | unsigned long flags; |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 419 | int r = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 420 | char *tx_buf; |
| 421 | |
| 422 | spin_lock_irqsave(&catc->tx_lock, flags); |
| 423 | |
| 424 | catc->tx_ptr = (((catc->tx_ptr - 1) >> 6) + 1) << 6; |
| 425 | tx_buf = catc->tx_buf[catc->tx_idx] + catc->tx_ptr; |
Al Viro | 4ec7ffa | 2008-05-21 06:32:11 +0100 | [diff] [blame] | 426 | if (catc->is_f5u011) |
| 427 | *(__be16 *)tx_buf = cpu_to_be16(skb->len); |
| 428 | else |
| 429 | *(__le16 *)tx_buf = cpu_to_le16(skb->len); |
Arnaldo Carvalho de Melo | d626f62 | 2007-03-27 18:55:52 -0300 | [diff] [blame] | 430 | skb_copy_from_linear_data(skb, tx_buf + 2, skb->len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | catc->tx_ptr += skb->len + 2; |
| 432 | |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 433 | if (!test_and_set_bit(TX_RUNNING, &catc->flags)) { |
| 434 | r = catc_tx_run(catc); |
| 435 | if (r < 0) |
| 436 | clear_bit(TX_RUNNING, &catc->flags); |
| 437 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 438 | |
Joe Perches | 8e95a20 | 2009-12-03 07:58:21 +0000 | [diff] [blame] | 439 | if ((catc->is_f5u011 && catc->tx_ptr) || |
| 440 | (catc->tx_ptr >= ((TX_MAX_BURST - 1) * (PKT_SZ + 2)))) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 441 | netif_stop_queue(netdev); |
| 442 | |
| 443 | spin_unlock_irqrestore(&catc->tx_lock, flags); |
| 444 | |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 445 | if (r >= 0) { |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 446 | catc->netdev->stats.tx_bytes += skb->len; |
| 447 | catc->netdev->stats.tx_packets++; |
Oliver Neukum | 5a9f4e3 | 2007-03-30 13:11:00 +0200 | [diff] [blame] | 448 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 | |
| 450 | dev_kfree_skb(skb); |
| 451 | |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 452 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 453 | } |
| 454 | |
| 455 | static void catc_tx_timeout(struct net_device *netdev) |
| 456 | { |
| 457 | struct catc *catc = netdev_priv(netdev); |
| 458 | |
Greg Kroah-Hartman | 4dc8994 | 2008-08-14 09:37:34 -0700 | [diff] [blame] | 459 | dev_warn(&netdev->dev, "Transmit timed out.\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 460 | usb_unlink_urb(catc->tx_urb); |
| 461 | } |
| 462 | |
| 463 | /* |
| 464 | * Control messages. |
| 465 | */ |
| 466 | |
| 467 | static int catc_ctrl_msg(struct catc *catc, u8 dir, u8 request, u16 value, u16 index, void *buf, int len) |
| 468 | { |
| 469 | int retval = usb_control_msg(catc->usbdev, |
| 470 | dir ? usb_rcvctrlpipe(catc->usbdev, 0) : usb_sndctrlpipe(catc->usbdev, 0), |
| 471 | request, 0x40 | dir, value, index, buf, len, 1000); |
| 472 | return retval < 0 ? retval : 0; |
| 473 | } |
| 474 | |
| 475 | static void catc_ctrl_run(struct catc *catc) |
| 476 | { |
| 477 | struct ctrl_queue *q = catc->ctrl_queue + catc->ctrl_tail; |
| 478 | struct usb_device *usbdev = catc->usbdev; |
| 479 | struct urb *urb = catc->ctrl_urb; |
| 480 | struct usb_ctrlrequest *dr = &catc->ctrl_dr; |
| 481 | int status; |
| 482 | |
| 483 | dr->bRequest = q->request; |
| 484 | dr->bRequestType = 0x40 | q->dir; |
| 485 | dr->wValue = cpu_to_le16(q->value); |
| 486 | dr->wIndex = cpu_to_le16(q->index); |
| 487 | dr->wLength = cpu_to_le16(q->len); |
| 488 | |
| 489 | urb->pipe = q->dir ? usb_rcvctrlpipe(usbdev, 0) : usb_sndctrlpipe(usbdev, 0); |
| 490 | urb->transfer_buffer_length = q->len; |
| 491 | urb->transfer_buffer = catc->ctrl_buf; |
| 492 | urb->setup_packet = (void *) dr; |
| 493 | urb->dev = usbdev; |
| 494 | |
| 495 | if (!q->dir && q->buf && q->len) |
| 496 | memcpy(catc->ctrl_buf, q->buf, q->len); |
| 497 | |
| 498 | if ((status = usb_submit_urb(catc->ctrl_urb, GFP_KERNEL))) |
| 499 | err("submit(ctrl_urb) status %d", status); |
| 500 | } |
| 501 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 502 | static void catc_ctrl_done(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 503 | { |
| 504 | struct catc *catc = urb->context; |
| 505 | struct ctrl_queue *q; |
| 506 | unsigned long flags; |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 507 | int status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 508 | |
Oliver Neukum | c94cb31 | 2008-12-18 23:00:59 -0800 | [diff] [blame] | 509 | if (status) |
| 510 | dbg("ctrl_done, status %d, len %d.", status, urb->actual_length); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 511 | |
| 512 | spin_lock_irqsave(&catc->ctrl_lock, flags); |
| 513 | |
| 514 | q = catc->ctrl_queue + catc->ctrl_tail; |
| 515 | |
| 516 | if (q->dir) { |
| 517 | if (q->buf && q->len) |
| 518 | memcpy(q->buf, catc->ctrl_buf, q->len); |
| 519 | else |
| 520 | q->buf = catc->ctrl_buf; |
| 521 | } |
| 522 | |
| 523 | if (q->callback) |
| 524 | q->callback(catc, q); |
| 525 | |
| 526 | catc->ctrl_tail = (catc->ctrl_tail + 1) & (CTRL_QUEUE - 1); |
| 527 | |
| 528 | if (catc->ctrl_head != catc->ctrl_tail) |
| 529 | catc_ctrl_run(catc); |
| 530 | else |
| 531 | clear_bit(CTRL_RUNNING, &catc->flags); |
| 532 | |
| 533 | spin_unlock_irqrestore(&catc->ctrl_lock, flags); |
| 534 | } |
| 535 | |
| 536 | static int catc_ctrl_async(struct catc *catc, u8 dir, u8 request, u16 value, |
| 537 | u16 index, void *buf, int len, void (*callback)(struct catc *catc, struct ctrl_queue *q)) |
| 538 | { |
| 539 | struct ctrl_queue *q; |
| 540 | int retval = 0; |
| 541 | unsigned long flags; |
| 542 | |
| 543 | spin_lock_irqsave(&catc->ctrl_lock, flags); |
| 544 | |
| 545 | q = catc->ctrl_queue + catc->ctrl_head; |
| 546 | |
| 547 | q->dir = dir; |
| 548 | q->request = request; |
| 549 | q->value = value; |
| 550 | q->index = index; |
| 551 | q->buf = buf; |
| 552 | q->len = len; |
| 553 | q->callback = callback; |
| 554 | |
| 555 | catc->ctrl_head = (catc->ctrl_head + 1) & (CTRL_QUEUE - 1); |
| 556 | |
| 557 | if (catc->ctrl_head == catc->ctrl_tail) { |
| 558 | err("ctrl queue full"); |
| 559 | catc->ctrl_tail = (catc->ctrl_tail + 1) & (CTRL_QUEUE - 1); |
| 560 | retval = -1; |
| 561 | } |
| 562 | |
| 563 | if (!test_and_set_bit(CTRL_RUNNING, &catc->flags)) |
| 564 | catc_ctrl_run(catc); |
| 565 | |
| 566 | spin_unlock_irqrestore(&catc->ctrl_lock, flags); |
| 567 | |
| 568 | return retval; |
| 569 | } |
| 570 | |
| 571 | /* |
| 572 | * Statistics. |
| 573 | */ |
| 574 | |
| 575 | static void catc_stats_done(struct catc *catc, struct ctrl_queue *q) |
| 576 | { |
| 577 | int index = q->index - EthStats; |
| 578 | u16 data, last; |
| 579 | |
| 580 | catc->stats_buf[index] = *((char *)q->buf); |
| 581 | |
| 582 | if (index & 1) |
| 583 | return; |
| 584 | |
| 585 | data = ((u16)catc->stats_buf[index] << 8) | catc->stats_buf[index + 1]; |
| 586 | last = catc->stats_vals[index >> 1]; |
| 587 | |
| 588 | switch (index) { |
| 589 | case TxSingleColl: |
| 590 | case TxMultiColl: |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 591 | catc->netdev->stats.collisions += data - last; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 592 | break; |
| 593 | case TxExcessColl: |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 594 | catc->netdev->stats.tx_aborted_errors += data - last; |
| 595 | catc->netdev->stats.tx_errors += data - last; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 596 | break; |
| 597 | case RxFramErr: |
Stephen Hemminger | edc4ae0 | 2009-03-20 19:35:48 +0000 | [diff] [blame] | 598 | catc->netdev->stats.rx_frame_errors += data - last; |
| 599 | catc->netdev->stats.rx_errors += data - last; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | break; |
| 601 | } |
| 602 | |
| 603 | catc->stats_vals[index >> 1] = data; |
| 604 | } |
| 605 | |
| 606 | static void catc_stats_timer(unsigned long data) |
| 607 | { |
| 608 | struct catc *catc = (void *) data; |
| 609 | int i; |
| 610 | |
| 611 | for (i = 0; i < 8; i++) |
| 612 | catc_get_reg_async(catc, EthStats + 7 - i, catc_stats_done); |
| 613 | |
| 614 | mod_timer(&catc->timer, jiffies + STATS_UPDATE); |
| 615 | } |
| 616 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 617 | /* |
| 618 | * Receive modes. Broadcast, Multicast, Promisc. |
| 619 | */ |
| 620 | |
| 621 | static void catc_multicast(unsigned char *addr, u8 *multicast) |
| 622 | { |
| 623 | u32 crc; |
| 624 | |
| 625 | crc = ether_crc_le(6, addr); |
| 626 | multicast[(crc >> 3) & 0x3f] |= 1 << (crc & 7); |
| 627 | } |
| 628 | |
| 629 | static void catc_set_multicast_list(struct net_device *netdev) |
| 630 | { |
| 631 | struct catc *catc = netdev_priv(netdev); |
| 632 | struct dev_mc_list *mc; |
| 633 | u8 broadcast[6]; |
| 634 | u8 rx = RxEnable | RxPolarity | RxMultiCast; |
| 635 | int i; |
| 636 | |
| 637 | memset(broadcast, 0xff, 6); |
| 638 | memset(catc->multicast, 0, 64); |
| 639 | |
| 640 | catc_multicast(broadcast, catc->multicast); |
| 641 | catc_multicast(netdev->dev_addr, catc->multicast); |
| 642 | |
| 643 | if (netdev->flags & IFF_PROMISC) { |
| 644 | memset(catc->multicast, 0xff, 64); |
| 645 | rx |= (!catc->is_f5u011) ? RxPromisc : AltRxPromisc; |
| 646 | } |
| 647 | |
| 648 | if (netdev->flags & IFF_ALLMULTI) { |
| 649 | memset(catc->multicast, 0xff, 64); |
| 650 | } else { |
| 651 | for (i = 0, mc = netdev->mc_list; mc && i < netdev->mc_count; i++, mc = mc->next) { |
| 652 | u32 crc = ether_crc_le(6, mc->dmi_addr); |
| 653 | if (!catc->is_f5u011) { |
| 654 | catc->multicast[(crc >> 3) & 0x3f] |= 1 << (crc & 7); |
| 655 | } else { |
| 656 | catc->multicast[7-(crc >> 29)] |= 1 << ((crc >> 26) & 7); |
| 657 | } |
| 658 | } |
| 659 | } |
| 660 | if (!catc->is_f5u011) { |
| 661 | catc_set_reg_async(catc, RxUnit, rx); |
| 662 | catc_write_mem_async(catc, 0xfa80, catc->multicast, 64); |
| 663 | } else { |
| 664 | f5u011_mchash_async(catc, catc->multicast); |
| 665 | if (catc->rxmode[0] != rx) { |
| 666 | catc->rxmode[0] = rx; |
| 667 | dbg("Setting RX mode to %2.2X %2.2X", catc->rxmode[0], catc->rxmode[1]); |
| 668 | f5u011_rxmode_async(catc, catc->rxmode); |
| 669 | } |
| 670 | } |
| 671 | } |
| 672 | |
| 673 | static void catc_get_drvinfo(struct net_device *dev, |
| 674 | struct ethtool_drvinfo *info) |
| 675 | { |
| 676 | struct catc *catc = netdev_priv(dev); |
| 677 | strncpy(info->driver, driver_name, ETHTOOL_BUSINFO_LEN); |
| 678 | strncpy(info->version, DRIVER_VERSION, ETHTOOL_BUSINFO_LEN); |
| 679 | usb_make_path (catc->usbdev, info->bus_info, sizeof info->bus_info); |
| 680 | } |
| 681 | |
| 682 | static int catc_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) |
| 683 | { |
| 684 | struct catc *catc = netdev_priv(dev); |
| 685 | if (!catc->is_f5u011) |
| 686 | return -EOPNOTSUPP; |
| 687 | |
| 688 | cmd->supported = SUPPORTED_10baseT_Half | SUPPORTED_TP; |
| 689 | cmd->advertising = ADVERTISED_10baseT_Half | ADVERTISED_TP; |
| 690 | cmd->speed = SPEED_10; |
| 691 | cmd->duplex = DUPLEX_HALF; |
| 692 | cmd->port = PORT_TP; |
| 693 | cmd->phy_address = 0; |
| 694 | cmd->transceiver = XCVR_INTERNAL; |
| 695 | cmd->autoneg = AUTONEG_DISABLE; |
| 696 | cmd->maxtxpkt = 1; |
| 697 | cmd->maxrxpkt = 1; |
| 698 | return 0; |
| 699 | } |
| 700 | |
Stephen Hemminger | 0fc0b73 | 2009-09-02 01:03:33 -0700 | [diff] [blame] | 701 | static const struct ethtool_ops ops = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 702 | .get_drvinfo = catc_get_drvinfo, |
| 703 | .get_settings = catc_get_settings, |
| 704 | .get_link = ethtool_op_get_link |
| 705 | }; |
| 706 | |
| 707 | /* |
| 708 | * Open, close. |
| 709 | */ |
| 710 | |
| 711 | static int catc_open(struct net_device *netdev) |
| 712 | { |
| 713 | struct catc *catc = netdev_priv(netdev); |
| 714 | int status; |
| 715 | |
| 716 | catc->irq_urb->dev = catc->usbdev; |
| 717 | if ((status = usb_submit_urb(catc->irq_urb, GFP_KERNEL)) < 0) { |
| 718 | err("submit(irq_urb) status %d", status); |
| 719 | return -1; |
| 720 | } |
| 721 | |
| 722 | netif_start_queue(netdev); |
| 723 | |
| 724 | if (!catc->is_f5u011) |
| 725 | mod_timer(&catc->timer, jiffies + STATS_UPDATE); |
| 726 | |
| 727 | return 0; |
| 728 | } |
| 729 | |
| 730 | static int catc_stop(struct net_device *netdev) |
| 731 | { |
| 732 | struct catc *catc = netdev_priv(netdev); |
| 733 | |
| 734 | netif_stop_queue(netdev); |
| 735 | |
| 736 | if (!catc->is_f5u011) |
| 737 | del_timer_sync(&catc->timer); |
| 738 | |
| 739 | usb_kill_urb(catc->rx_urb); |
| 740 | usb_kill_urb(catc->tx_urb); |
| 741 | usb_kill_urb(catc->irq_urb); |
| 742 | usb_kill_urb(catc->ctrl_urb); |
| 743 | |
| 744 | return 0; |
| 745 | } |
| 746 | |
Stephen Hemminger | 19b8f8f | 2009-03-20 19:35:49 +0000 | [diff] [blame] | 747 | static const struct net_device_ops catc_netdev_ops = { |
| 748 | .ndo_open = catc_open, |
| 749 | .ndo_stop = catc_stop, |
| 750 | .ndo_start_xmit = catc_start_xmit, |
| 751 | |
| 752 | .ndo_tx_timeout = catc_tx_timeout, |
| 753 | .ndo_set_multicast_list = catc_set_multicast_list, |
| 754 | .ndo_change_mtu = eth_change_mtu, |
| 755 | .ndo_set_mac_address = eth_mac_addr, |
| 756 | .ndo_validate_addr = eth_validate_addr, |
| 757 | }; |
| 758 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 759 | /* |
| 760 | * USB probe, disconnect. |
| 761 | */ |
| 762 | |
| 763 | static int catc_probe(struct usb_interface *intf, const struct usb_device_id *id) |
| 764 | { |
| 765 | struct usb_device *usbdev = interface_to_usbdev(intf); |
| 766 | struct net_device *netdev; |
| 767 | struct catc *catc; |
| 768 | u8 broadcast[6]; |
| 769 | int i, pktsz; |
| 770 | |
| 771 | if (usb_set_interface(usbdev, |
| 772 | intf->altsetting->desc.bInterfaceNumber, 1)) { |
| 773 | err("Can't set altsetting 1."); |
| 774 | return -EIO; |
| 775 | } |
| 776 | |
| 777 | netdev = alloc_etherdev(sizeof(struct catc)); |
| 778 | if (!netdev) |
| 779 | return -ENOMEM; |
| 780 | |
| 781 | catc = netdev_priv(netdev); |
| 782 | |
Stephen Hemminger | 19b8f8f | 2009-03-20 19:35:49 +0000 | [diff] [blame] | 783 | netdev->netdev_ops = &catc_netdev_ops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 784 | netdev->watchdog_timeo = TX_TIMEOUT; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 785 | SET_ETHTOOL_OPS(netdev, &ops); |
| 786 | |
| 787 | catc->usbdev = usbdev; |
| 788 | catc->netdev = netdev; |
| 789 | |
| 790 | spin_lock_init(&catc->tx_lock); |
| 791 | spin_lock_init(&catc->ctrl_lock); |
| 792 | |
| 793 | init_timer(&catc->timer); |
| 794 | catc->timer.data = (long) catc; |
| 795 | catc->timer.function = catc_stats_timer; |
| 796 | |
| 797 | catc->ctrl_urb = usb_alloc_urb(0, GFP_KERNEL); |
| 798 | catc->tx_urb = usb_alloc_urb(0, GFP_KERNEL); |
| 799 | catc->rx_urb = usb_alloc_urb(0, GFP_KERNEL); |
| 800 | catc->irq_urb = usb_alloc_urb(0, GFP_KERNEL); |
| 801 | if ((!catc->ctrl_urb) || (!catc->tx_urb) || |
| 802 | (!catc->rx_urb) || (!catc->irq_urb)) { |
| 803 | err("No free urbs available."); |
Mariusz Kozlowski | c69694b | 2006-11-08 15:36:22 +0100 | [diff] [blame] | 804 | usb_free_urb(catc->ctrl_urb); |
| 805 | usb_free_urb(catc->tx_urb); |
| 806 | usb_free_urb(catc->rx_urb); |
| 807 | usb_free_urb(catc->irq_urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 808 | free_netdev(netdev); |
| 809 | return -ENOMEM; |
| 810 | } |
| 811 | |
| 812 | /* The F5U011 has the same vendor/product as the netmate but a device version of 0x130 */ |
| 813 | if (le16_to_cpu(usbdev->descriptor.idVendor) == 0x0423 && |
| 814 | le16_to_cpu(usbdev->descriptor.idProduct) == 0xa && |
| 815 | le16_to_cpu(catc->usbdev->descriptor.bcdDevice) == 0x0130) { |
| 816 | dbg("Testing for f5u011"); |
| 817 | catc->is_f5u011 = 1; |
| 818 | atomic_set(&catc->recq_sz, 0); |
| 819 | pktsz = RX_PKT_SZ; |
| 820 | } else { |
| 821 | pktsz = RX_MAX_BURST * (PKT_SZ + 2); |
| 822 | } |
| 823 | |
| 824 | usb_fill_control_urb(catc->ctrl_urb, usbdev, usb_sndctrlpipe(usbdev, 0), |
| 825 | NULL, NULL, 0, catc_ctrl_done, catc); |
| 826 | |
| 827 | usb_fill_bulk_urb(catc->tx_urb, usbdev, usb_sndbulkpipe(usbdev, 1), |
| 828 | NULL, 0, catc_tx_done, catc); |
| 829 | |
| 830 | usb_fill_bulk_urb(catc->rx_urb, usbdev, usb_rcvbulkpipe(usbdev, 1), |
| 831 | catc->rx_buf, pktsz, catc_rx_done, catc); |
| 832 | |
| 833 | usb_fill_int_urb(catc->irq_urb, usbdev, usb_rcvintpipe(usbdev, 2), |
| 834 | catc->irq_buf, 2, catc_irq_done, catc, 1); |
| 835 | |
| 836 | if (!catc->is_f5u011) { |
| 837 | dbg("Checking memory size\n"); |
| 838 | |
| 839 | i = 0x12345678; |
| 840 | catc_write_mem(catc, 0x7a80, &i, 4); |
| 841 | i = 0x87654321; |
| 842 | catc_write_mem(catc, 0xfa80, &i, 4); |
| 843 | catc_read_mem(catc, 0x7a80, &i, 4); |
| 844 | |
| 845 | switch (i) { |
| 846 | case 0x12345678: |
| 847 | catc_set_reg(catc, TxBufCount, 8); |
| 848 | catc_set_reg(catc, RxBufCount, 32); |
| 849 | dbg("64k Memory\n"); |
| 850 | break; |
| 851 | default: |
Greg Kroah-Hartman | 4dc8994 | 2008-08-14 09:37:34 -0700 | [diff] [blame] | 852 | dev_warn(&intf->dev, |
| 853 | "Couldn't detect memory size, assuming 32k\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 | case 0x87654321: |
| 855 | catc_set_reg(catc, TxBufCount, 4); |
| 856 | catc_set_reg(catc, RxBufCount, 16); |
| 857 | dbg("32k Memory\n"); |
| 858 | break; |
| 859 | } |
| 860 | |
| 861 | dbg("Getting MAC from SEEROM."); |
| 862 | |
| 863 | catc_get_mac(catc, netdev->dev_addr); |
| 864 | |
| 865 | dbg("Setting MAC into registers."); |
| 866 | |
| 867 | for (i = 0; i < 6; i++) |
| 868 | catc_set_reg(catc, StationAddr0 - i, netdev->dev_addr[i]); |
| 869 | |
| 870 | dbg("Filling the multicast list."); |
| 871 | |
| 872 | memset(broadcast, 0xff, 6); |
| 873 | catc_multicast(broadcast, catc->multicast); |
| 874 | catc_multicast(netdev->dev_addr, catc->multicast); |
| 875 | catc_write_mem(catc, 0xfa80, catc->multicast, 64); |
| 876 | |
| 877 | dbg("Clearing error counters."); |
| 878 | |
| 879 | for (i = 0; i < 8; i++) |
| 880 | catc_set_reg(catc, EthStats + i, 0); |
| 881 | catc->last_stats = jiffies; |
| 882 | |
| 883 | dbg("Enabling."); |
| 884 | |
| 885 | catc_set_reg(catc, MaxBurst, RX_MAX_BURST); |
| 886 | catc_set_reg(catc, OpModes, OpTxMerge | OpRxMerge | OpLenInclude | Op3MemWaits); |
| 887 | catc_set_reg(catc, LEDCtrl, LEDLink); |
| 888 | catc_set_reg(catc, RxUnit, RxEnable | RxPolarity | RxMultiCast); |
| 889 | } else { |
| 890 | dbg("Performing reset\n"); |
| 891 | catc_reset(catc); |
| 892 | catc_get_mac(catc, netdev->dev_addr); |
| 893 | |
| 894 | dbg("Setting RX Mode"); |
| 895 | catc->rxmode[0] = RxEnable | RxPolarity | RxMultiCast; |
| 896 | catc->rxmode[1] = 0; |
| 897 | f5u011_rxmode(catc, catc->rxmode); |
| 898 | } |
| 899 | dbg("Init done."); |
| 900 | printk(KERN_INFO "%s: %s USB Ethernet at usb-%s-%s, ", |
| 901 | netdev->name, (catc->is_f5u011) ? "Belkin F5U011" : "CATC EL1210A NetMate", |
| 902 | usbdev->bus->bus_name, usbdev->devpath); |
| 903 | for (i = 0; i < 5; i++) printk("%2.2x:", netdev->dev_addr[i]); |
| 904 | printk("%2.2x.\n", netdev->dev_addr[i]); |
| 905 | usb_set_intfdata(intf, catc); |
| 906 | |
| 907 | SET_NETDEV_DEV(netdev, &intf->dev); |
| 908 | if (register_netdev(netdev) != 0) { |
| 909 | usb_set_intfdata(intf, NULL); |
| 910 | usb_free_urb(catc->ctrl_urb); |
| 911 | usb_free_urb(catc->tx_urb); |
| 912 | usb_free_urb(catc->rx_urb); |
| 913 | usb_free_urb(catc->irq_urb); |
| 914 | free_netdev(netdev); |
| 915 | return -EIO; |
| 916 | } |
| 917 | return 0; |
| 918 | } |
| 919 | |
| 920 | static void catc_disconnect(struct usb_interface *intf) |
| 921 | { |
| 922 | struct catc *catc = usb_get_intfdata(intf); |
| 923 | |
| 924 | usb_set_intfdata(intf, NULL); |
| 925 | if (catc) { |
| 926 | unregister_netdev(catc->netdev); |
| 927 | usb_free_urb(catc->ctrl_urb); |
| 928 | usb_free_urb(catc->tx_urb); |
| 929 | usb_free_urb(catc->rx_urb); |
| 930 | usb_free_urb(catc->irq_urb); |
| 931 | free_netdev(catc->netdev); |
| 932 | } |
| 933 | } |
| 934 | |
| 935 | /* |
| 936 | * Module functions and tables. |
| 937 | */ |
| 938 | |
| 939 | static struct usb_device_id catc_id_table [] = { |
| 940 | { USB_DEVICE(0x0423, 0xa) }, /* CATC Netmate, Belkin F5U011 */ |
| 941 | { USB_DEVICE(0x0423, 0xc) }, /* CATC Netmate II, Belkin F5U111 */ |
| 942 | { USB_DEVICE(0x08d1, 0x1) }, /* smartBridges smartNIC */ |
| 943 | { } |
| 944 | }; |
| 945 | |
| 946 | MODULE_DEVICE_TABLE(usb, catc_id_table); |
| 947 | |
| 948 | static struct usb_driver catc_driver = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 949 | .name = driver_name, |
| 950 | .probe = catc_probe, |
| 951 | .disconnect = catc_disconnect, |
| 952 | .id_table = catc_id_table, |
| 953 | }; |
| 954 | |
| 955 | static int __init catc_init(void) |
| 956 | { |
| 957 | int result = usb_register(&catc_driver); |
| 958 | if (result == 0) |
Greg Kroah-Hartman | 880c9c6 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 959 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" |
| 960 | DRIVER_DESC "\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 961 | return result; |
| 962 | } |
| 963 | |
| 964 | static void __exit catc_exit(void) |
| 965 | { |
| 966 | usb_deregister(&catc_driver); |
| 967 | } |
| 968 | |
| 969 | module_init(catc_init); |
| 970 | module_exit(catc_exit); |