?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86: fix bootup crash in native_read_tsc()
[wrt350n-kernel.git] / drivers / net / usb / net1080.c
blob034e8a73ca6b487dc7ab32e02ba11d77d71ab72e
1 /*
2 * Net1080 based USB host-to-host cables
3 * Copyright (C) 2000-2005 by David Brownell
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18 */
19
20 // #define DEBUG // error path messages, extra info
21 // #define VERBOSE // more; success messages
22
23 #include <linux/module.h>
24 #include <linux/init.h>
25 #include <linux/netdevice.h>
26 #include <linux/etherdevice.h>
27 #include <linux/ethtool.h>
28 #include <linux/workqueue.h>
29 #include <linux/mii.h>
30 #include <linux/usb.h>
31 #include <linux/usb/usbnet.h>
32
33 #include <asm/unaligned.h>
34
35
36 /*
37 * Netchip 1080 driver ... http://www.netchip.com
38 * (Sept 2004: End-of-life announcement has been sent.)
39 * Used in (some) LapLink cables
40 */
41
42 #define frame_errors data[1]
43
44 /*
45 * NetChip framing of ethernet packets, supporting additional error
46 * checks for links that may drop bulk packets from inside messages.
47 * Odd USB length == always short read for last usb packet.
48 * - nc_header
49 * - Ethernet header (14 bytes)
50 * - payload
51 * - (optional padding byte, if needed so length becomes odd)
52 * - nc_trailer
53 *
54 * This framing is to be avoided for non-NetChip devices.
55 */
56
57 struct nc_header { // packed:
58 __le16 hdr_len; // sizeof nc_header (LE, all)
59 __le16 packet_len; // payload size (including ethhdr)
60 __le16 packet_id; // detects dropped packets
61 #define MIN_HEADER 6
62
63 // all else is optional, and must start with:
64 // __le16 vendorId; // from usb-if
65 // __le16 productId;
66 } __attribute__((__packed__));
67
68 #define PAD_BYTE ((unsigned char)0xAC)
69
70 struct nc_trailer {
71 __le16 packet_id;
72 } __attribute__((__packed__));
73
74 // packets may use FLAG_FRAMING_NC and optional pad
75 #define FRAMED_SIZE(mtu) (sizeof (struct nc_header) \
76 + sizeof (struct ethhdr) \
77 + (mtu) \
78 + 1 \
79 + sizeof (struct nc_trailer))
80
81 #define MIN_FRAMED FRAMED_SIZE(0)
82
83 /* packets _could_ be up to 64KB... */
84 #define NC_MAX_PACKET 32767
85
86
87 /*
88 * Zero means no timeout; else, how long a 64 byte bulk packet may be queued
89 * before the hardware drops it. If that's done, the driver will need to
90 * frame network packets to guard against the dropped USB packets. The win32
91 * driver sets this for both sides of the link.
92 */
93 #define NC_READ_TTL_MS ((u8)255) // ms
94
95 /*
96 * We ignore most registers and EEPROM contents.
97 */
98 #define REG_USBCTL ((u8)0x04)
99 #define REG_TTL ((u8)0x10)
100 #define REG_STATUS ((u8)0x11)
101
102 /*
103 * Vendor specific requests to read/write data
104 */
105 #define REQUEST_REGISTER ((u8)0x10)
106 #define REQUEST_EEPROM ((u8)0x11)
107
108 static int
109 nc_vendor_read(struct usbnet *dev, u8 req, u8 regnum, u16 *retval_ptr)
110 {
111 int status = usb_control_msg(dev->udev,
112 usb_rcvctrlpipe(dev->udev, 0),
113 req,
114 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
115 0, regnum,
116 retval_ptr, sizeof *retval_ptr,
117 USB_CTRL_GET_TIMEOUT);
118 if (status > 0)
119 status = 0;
120 if (!status)
121 le16_to_cpus(retval_ptr);
122 return status;
123 }
124
125 static inline int
126 nc_register_read(struct usbnet *dev, u8 regnum, u16 *retval_ptr)
127 {
128 return nc_vendor_read(dev, REQUEST_REGISTER, regnum, retval_ptr);
129 }
130
131 // no retval ... can become async, usable in_interrupt()
132 static void
133 nc_vendor_write(struct usbnet *dev, u8 req, u8 regnum, u16 value)
134 {
135 usb_control_msg(dev->udev,
136 usb_sndctrlpipe(dev->udev, 0),
137 req,
138 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
139 value, regnum,
140 NULL, 0, // data is in setup packet
141 USB_CTRL_SET_TIMEOUT);
142 }
143
144 static inline void
145 nc_register_write(struct usbnet *dev, u8 regnum, u16 value)
146 {
147 nc_vendor_write(dev, REQUEST_REGISTER, regnum, value);
148 }
149
150
151 #if 0
152 static void nc_dump_registers(struct usbnet *dev)
153 {
154 u8 reg;
155 u16 *vp = kmalloc(sizeof (u16));
156
157 if (!vp) {
158 dbg("no memory?");
159 return;
160 }
161
162 dbg("%s registers:", dev->net->name);
163 for (reg = 0; reg < 0x20; reg++) {
164 int retval;
165
166 // reading some registers is trouble
167 if (reg >= 0x08 && reg <= 0xf)
168 continue;
169 if (reg >= 0x12 && reg <= 0x1e)
170 continue;
171
172 retval = nc_register_read(dev, reg, vp);
173 if (retval < 0)
174 dbg("%s reg [0x%x] ==> error %d",
175 dev->net->name, reg, retval);
176 else
177 dbg("%s reg [0x%x] = 0x%x",
178 dev->net->name, reg, *vp);
179 }
180 kfree(vp);
181 }
182 #endif
183
184
185 /*-------------------------------------------------------------------------*/
186
187 /*
188 * Control register
189 */
190
191 #define USBCTL_WRITABLE_MASK 0x1f0f
192 // bits 15-13 reserved, r/o
193 #define USBCTL_ENABLE_LANG (1 << 12)
194 #define USBCTL_ENABLE_MFGR (1 << 11)
195 #define USBCTL_ENABLE_PROD (1 << 10)
196 #define USBCTL_ENABLE_SERIAL (1 << 9)
197 #define USBCTL_ENABLE_DEFAULTS (1 << 8)
198 // bits 7-4 reserved, r/o
199 #define USBCTL_FLUSH_OTHER (1 << 3)
200 #define USBCTL_FLUSH_THIS (1 << 2)
201 #define USBCTL_DISCONN_OTHER (1 << 1)
202 #define USBCTL_DISCONN_THIS (1 << 0)
203
204 static inline void nc_dump_usbctl(struct usbnet *dev, u16 usbctl)
205 {
206 if (!netif_msg_link(dev))
207 return;
208 devdbg(dev, "net1080 %s-%s usbctl 0x%x:%s%s%s%s%s;"
209 " this%s%s;"
210 " other%s%s; r/o 0x%x",
211 dev->udev->bus->bus_name, dev->udev->devpath,
212 usbctl,
213 (usbctl & USBCTL_ENABLE_LANG) ? " lang" : "",
214 (usbctl & USBCTL_ENABLE_MFGR) ? " mfgr" : "",
215 (usbctl & USBCTL_ENABLE_PROD) ? " prod" : "",
216 (usbctl & USBCTL_ENABLE_SERIAL) ? " serial" : "",
217 (usbctl & USBCTL_ENABLE_DEFAULTS) ? " defaults" : "",
218
219 (usbctl & USBCTL_FLUSH_OTHER) ? " FLUSH" : "",
220 (usbctl & USBCTL_DISCONN_OTHER) ? " DIS" : "",
221 (usbctl & USBCTL_FLUSH_THIS) ? " FLUSH" : "",
222 (usbctl & USBCTL_DISCONN_THIS) ? " DIS" : "",
223 usbctl & ~USBCTL_WRITABLE_MASK
224 );
225 }
226
227 /*-------------------------------------------------------------------------*/
228
229 /*
230 * Status register
231 */
232
233 #define STATUS_PORT_A (1 << 15)
234
235 #define STATUS_CONN_OTHER (1 << 14)
236 #define STATUS_SUSPEND_OTHER (1 << 13)
237 #define STATUS_MAILBOX_OTHER (1 << 12)
238 #define STATUS_PACKETS_OTHER(n) (((n) >> 8) & 0x03)
239
240 #define STATUS_CONN_THIS (1 << 6)
241 #define STATUS_SUSPEND_THIS (1 << 5)
242 #define STATUS_MAILBOX_THIS (1 << 4)
243 #define STATUS_PACKETS_THIS(n) (((n) >> 0) & 0x03)
244
245 #define STATUS_UNSPEC_MASK 0x0c8c
246 #define STATUS_NOISE_MASK ((u16)~(0x0303|STATUS_UNSPEC_MASK))
247
248
249 static inline void nc_dump_status(struct usbnet *dev, u16 status)
250 {
251 if (!netif_msg_link(dev))
252 return;
253 devdbg(dev, "net1080 %s-%s status 0x%x:"
254 " this (%c) PKT=%d%s%s%s;"
255 " other PKT=%d%s%s%s; unspec 0x%x",
256 dev->udev->bus->bus_name, dev->udev->devpath,
257 status,
258
259 // XXX the packet counts don't seem right
260 // (1 at reset, not 0); maybe UNSPEC too
261
262 (status & STATUS_PORT_A) ? 'A' : 'B',
263 STATUS_PACKETS_THIS(status),
264 (status & STATUS_CONN_THIS) ? " CON" : "",
265 (status & STATUS_SUSPEND_THIS) ? " SUS" : "",
266 (status & STATUS_MAILBOX_THIS) ? " MBOX" : "",
267
268 STATUS_PACKETS_OTHER(status),
269 (status & STATUS_CONN_OTHER) ? " CON" : "",
270 (status & STATUS_SUSPEND_OTHER) ? " SUS" : "",
271 (status & STATUS_MAILBOX_OTHER) ? " MBOX" : "",
272
273 status & STATUS_UNSPEC_MASK
274 );
275 }
276
277 /*-------------------------------------------------------------------------*/
278
279 /*
280 * TTL register
281 */
282
283 #define TTL_THIS(ttl) (0x00ff & ttl)
284 #define TTL_OTHER(ttl) (0x00ff & (ttl >> 8))
285 #define MK_TTL(this,other) ((u16)(((other)<<8)|(0x00ff&(this))))
286
287 static inline void nc_dump_ttl(struct usbnet *dev, u16 ttl)
288 {
289 if (netif_msg_link(dev))
290 devdbg(dev, "net1080 %s-%s ttl 0x%x this = %d, other = %d",
291 dev->udev->bus->bus_name, dev->udev->devpath,
292 ttl, TTL_THIS(ttl), TTL_OTHER(ttl));
293 }
294
295 /*-------------------------------------------------------------------------*/
296
297 static int net1080_reset(struct usbnet *dev)
298 {
299 u16 usbctl, status, ttl;
300 u16 *vp = kmalloc(sizeof (u16), GFP_KERNEL);
301 int retval;
302
303 if (!vp)
304 return -ENOMEM;
305
306 // nc_dump_registers(dev);
307
308 if ((retval = nc_register_read(dev, REG_STATUS, vp)) < 0) {
309 dbg("can't read %s-%s status: %d",
310 dev->udev->bus->bus_name, dev->udev->devpath, retval);
311 goto done;
312 }
313 status = *vp;
314 nc_dump_status(dev, status);
315
316 if ((retval = nc_register_read(dev, REG_USBCTL, vp)) < 0) {
317 dbg("can't read USBCTL, %d", retval);
318 goto done;
319 }
320 usbctl = *vp;
321 nc_dump_usbctl(dev, usbctl);
322
323 nc_register_write(dev, REG_USBCTL,
324 USBCTL_FLUSH_THIS | USBCTL_FLUSH_OTHER);
325
326 if ((retval = nc_register_read(dev, REG_TTL, vp)) < 0) {
327 dbg("can't read TTL, %d", retval);
328 goto done;
329 }
330 ttl = *vp;
331 // nc_dump_ttl(dev, ttl);
332
333 nc_register_write(dev, REG_TTL,
334 MK_TTL(NC_READ_TTL_MS, TTL_OTHER(ttl)) );
335 dbg("%s: assigned TTL, %d ms", dev->net->name, NC_READ_TTL_MS);
336
337 if (netif_msg_link(dev))
338 devinfo(dev, "port %c, peer %sconnected",
339 (status & STATUS_PORT_A) ? 'A' : 'B',
340 (status & STATUS_CONN_OTHER) ? "" : "dis"
341 );
342 retval = 0;
343
344 done:
345 kfree(vp);
346 return retval;
347 }
348
349 static int net1080_check_connect(struct usbnet *dev)
350 {
351 int retval;
352 u16 status;
353 u16 *vp = kmalloc(sizeof (u16), GFP_KERNEL);
354
355 if (!vp)
356 return -ENOMEM;
357 retval = nc_register_read(dev, REG_STATUS, vp);
358 status = *vp;
359 kfree(vp);
360 if (retval != 0) {
361 dbg("%s net1080_check_conn read - %d", dev->net->name, retval);
362 return retval;
363 }
364 if ((status & STATUS_CONN_OTHER) != STATUS_CONN_OTHER)
365 return -ENOLINK;
366 return 0;
367 }
368
369 static void nc_flush_complete(struct urb *urb)
370 {
371 kfree(urb->context);
372 usb_free_urb(urb);
373 }
374
375 static void nc_ensure_sync(struct usbnet *dev)
376 {
377 dev->frame_errors++;
378 if (dev->frame_errors > 5) {
379 struct urb *urb;
380 struct usb_ctrlrequest *req;
381 int status;
382
383 /* Send a flush */
384 urb = usb_alloc_urb(0, GFP_ATOMIC);
385 if (!urb)
386 return;
387
388 req = kmalloc(sizeof *req, GFP_ATOMIC);
389 if (!req) {
390 usb_free_urb(urb);
391 return;
392 }
393
394 req->bRequestType = USB_DIR_OUT
395 | USB_TYPE_VENDOR
396 | USB_RECIP_DEVICE;
397 req->bRequest = REQUEST_REGISTER;
398 req->wValue = cpu_to_le16(USBCTL_FLUSH_THIS
399 | USBCTL_FLUSH_OTHER);
400 req->wIndex = cpu_to_le16(REG_USBCTL);
401 req->wLength = cpu_to_le16(0);
402
403 /* queue an async control request, we don't need
404 * to do anything when it finishes except clean up.
405 */
406 usb_fill_control_urb(urb, dev->udev,
407 usb_sndctrlpipe(dev->udev, 0),
408 (unsigned char *) req,
409 NULL, 0,
410 nc_flush_complete, req);
411 status = usb_submit_urb(urb, GFP_ATOMIC);
412 if (status) {
413 kfree(req);
414 usb_free_urb(urb);
415 return;
416 }
417
418 if (netif_msg_rx_err(dev))
419 devdbg(dev, "flush net1080; too many framing errors");
420 dev->frame_errors = 0;
421 }
422 }
423
424 static int net1080_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
425 {
426 struct nc_header *header;
427 struct nc_trailer *trailer;
428 u16 hdr_len, packet_len;
429
430 if (!(skb->len & 0x01)) {
431 #ifdef DEBUG
432 struct net_device *net = dev->net;
433 dbg("rx framesize %d range %d..%d mtu %d", skb->len,
434 net->hard_header_len, dev->hard_mtu, net->mtu);
435 #endif
436 dev->stats.rx_frame_errors++;
437 nc_ensure_sync(dev);
438 return 0;
439 }
440
441 header = (struct nc_header *) skb->data;
442 hdr_len = le16_to_cpup(&header->hdr_len);
443 packet_len = le16_to_cpup(&header->packet_len);
444 if (FRAMED_SIZE(packet_len) > NC_MAX_PACKET) {
445 dev->stats.rx_frame_errors++;
446 dbg("packet too big, %d", packet_len);
447 nc_ensure_sync(dev);
448 return 0;
449 } else if (hdr_len < MIN_HEADER) {
450 dev->stats.rx_frame_errors++;
451 dbg("header too short, %d", hdr_len);
452 nc_ensure_sync(dev);
453 return 0;
454 } else if (hdr_len > MIN_HEADER) {
455 // out of band data for us?
456 dbg("header OOB, %d bytes", hdr_len - MIN_HEADER);
457 nc_ensure_sync(dev);
458 // switch (vendor/product ids) { ... }
459 }
460 skb_pull(skb, hdr_len);
461
462 trailer = (struct nc_trailer *)
463 (skb->data + skb->len - sizeof *trailer);
464 skb_trim(skb, skb->len - sizeof *trailer);
465
466 if ((packet_len & 0x01) == 0) {
467 if (skb->data [packet_len] != PAD_BYTE) {
468 dev->stats.rx_frame_errors++;
469 dbg("bad pad");
470 return 0;
471 }
472 skb_trim(skb, skb->len - 1);
473 }
474 if (skb->len != packet_len) {
475 dev->stats.rx_frame_errors++;
476 dbg("bad packet len %d (expected %d)",
477 skb->len, packet_len);
478 nc_ensure_sync(dev);
479 return 0;
480 }
481 if (header->packet_id != get_unaligned(&trailer->packet_id)) {
482 dev->stats.rx_fifo_errors++;
483 dbg("(2+ dropped) rx packet_id mismatch 0x%x 0x%x",
484 le16_to_cpu(header->packet_id),
485 le16_to_cpu(trailer->packet_id));
486 return 0;
487 }
488 #if 0
489 devdbg(dev, "frame <rx h %d p %d id %d", header->hdr_len,
490 header->packet_len, header->packet_id);
491 #endif
492 dev->frame_errors = 0;
493 return 1;
494 }
495
496 static struct sk_buff *
497 net1080_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags)
498 {
499 struct sk_buff *skb2;
500 struct nc_header *header = NULL;
501 struct nc_trailer *trailer = NULL;
502 int padlen = sizeof (struct nc_trailer);
503 int len = skb->len;
504
505 if (!((len + padlen + sizeof (struct nc_header)) & 0x01))
506 padlen++;
507 if (!skb_cloned(skb)) {
508 int headroom = skb_headroom(skb);
509 int tailroom = skb_tailroom(skb);
510
511 if (padlen <= tailroom &&
512 sizeof(struct nc_header) <= headroom)
513 /* There's enough head and tail room */
514 goto encapsulate;
515
516 if ((sizeof (struct nc_header) + padlen) <
517 (headroom + tailroom)) {
518 /* There's enough total room, so just readjust */
519 skb->data = memmove(skb->head
520 + sizeof (struct nc_header),
521 skb->data, skb->len);
522 skb_set_tail_pointer(skb, len);
523 goto encapsulate;
524 }
525 }
526
527 /* Create a new skb to use with the correct size */
528 skb2 = skb_copy_expand(skb,
529 sizeof (struct nc_header),
530 padlen,
531 flags);
532 dev_kfree_skb_any(skb);
533 if (!skb2)
534 return skb2;
535 skb = skb2;
536
537 encapsulate:
538 /* header first */
539 header = (struct nc_header *) skb_push(skb, sizeof *header);
540 header->hdr_len = cpu_to_le16(sizeof (*header));
541 header->packet_len = cpu_to_le16(len);
542 header->packet_id = cpu_to_le16((u16)dev->xid++);
543
544 /* maybe pad; then trailer */
545 if (!((skb->len + sizeof *trailer) & 0x01))
546 *skb_put(skb, 1) = PAD_BYTE;
547 trailer = (struct nc_trailer *) skb_put(skb, sizeof *trailer);
548 put_unaligned(header->packet_id, &trailer->packet_id);
549 #if 0
550 devdbg(dev, "frame >tx h %d p %d id %d",
551 header->hdr_len, header->packet_len,
552 header->packet_id);
553 #endif
554 return skb;
555 }
556
557 static int net1080_bind(struct usbnet *dev, struct usb_interface *intf)
558 {
559 unsigned extra = sizeof (struct nc_header)
560 + 1
561 + sizeof (struct nc_trailer);
562
563 dev->net->hard_header_len += extra;
564 dev->rx_urb_size = dev->net->hard_header_len + dev->net->mtu;
565 dev->hard_mtu = NC_MAX_PACKET;
566 return usbnet_get_endpoints (dev, intf);
567 }
568
569 static const struct driver_info net1080_info = {
570 .description = "NetChip TurboCONNECT",
571 .flags = FLAG_FRAMING_NC,
572 .bind = net1080_bind,
573 .reset = net1080_reset,
574 .check_connect = net1080_check_connect,
575 .rx_fixup = net1080_rx_fixup,
576 .tx_fixup = net1080_tx_fixup,
577 };
578
579 static const struct usb_device_id products [] = {
580 {
581 USB_DEVICE(0x0525, 0x1080), // NetChip ref design
582 .driver_info = (unsigned long) &net1080_info,
583 }, {
584 USB_DEVICE(0x06D0, 0x0622), // Laplink Gold
585 .driver_info = (unsigned long) &net1080_info,
586 },
587 { }, // END
588 };
589 MODULE_DEVICE_TABLE(usb, products);
590
591 static struct usb_driver net1080_driver = {
592 .name = "net1080",
593 .id_table = products,
594 .probe = usbnet_probe,
595 .disconnect = usbnet_disconnect,
596 .suspend = usbnet_suspend,
597 .resume = usbnet_resume,
598 };
599
600 static int __init net1080_init(void)
601 {
602 return usb_register(&net1080_driver);
603 }
604 module_init(net1080_init);
605
606 static void __exit net1080_exit(void)
607 {
608 usb_deregister(&net1080_driver);
609 }
610 module_exit(net1080_exit);
611
612 MODULE_AUTHOR("David Brownell");
613 MODULE_DESCRIPTION("NetChip 1080 based USB Host-to-Host Links");
614 MODULE_LICENSE("GPL");
WRT350N Kernel Patches