]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/usb/gadget/net2280.c
projects / mirror_ubuntu-artful-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
USB: Fix EHCI warning
[mirror_ubuntu-artful-kernel.git] / drivers / usb / gadget / net2280.c
CommitLineData
1da177e4
LT		 1/*
2 * Driver for the PLX NET2280 USB device controller.
3 * Specs and errata are available from <http://www.plxtech.com>.
4 *
901b3d75 5 * PLX Technology Inc. (formerly NetChip Technology) supported the
1da177e4
LT		 6 * development of this driver.
7 *
8 *
9 * CODE STATUS HIGHLIGHTS
10 *
11 * This driver should work well with most "gadget" drivers, including
12 * the File Storage, Serial, and Ethernet/RNDIS gadget drivers
13 * as well as Gadget Zero and Gadgetfs.
14 *
15 * DMA is enabled by default. Drivers using transfer queues might use
16 * DMA chaining to remove IRQ latencies between transfers. (Except when
17 * short OUT transfers happen.) Drivers can use the req->no_interrupt
18 * hint to completely eliminate some IRQs, if a later IRQ is guaranteed
19 * and DMA chaining is enabled.
20 *
21 * Note that almost all the errata workarounds here are only needed for
22 * rev1 chips. Rev1a silicon (0110) fixes almost all of them.
23 */
24
25/*
26 * Copyright (C) 2003 David Brownell
27 * Copyright (C) 2003-2005 PLX Technology, Inc.
28 *
901b3d75
DB		 29 * Modified Seth Levy 2005 PLX Technology, Inc. to provide compatibility
30 * with 2282 chip
950ee4c8 31 *
1da177e4
LT		 32 * This program is free software; you can redistribute it and/or modify
33 * it under the terms of the GNU General Public License as published by
34 * the Free Software Foundation; either version 2 of the License, or
35 * (at your option) any later version.
36 *
37 * This program is distributed in the hope that it will be useful,
38 * but WITHOUT ANY WARRANTY; without even the implied warranty of
39 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
40 * GNU General Public License for more details.
41 *
42 * You should have received a copy of the GNU General Public License
43 * along with this program; if not, write to the Free Software
44 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
45 */
46
47#undef DEBUG /* messages on error and most fault paths */
48#undef VERBOSE /* extra debug messages (success too) */
49
1da177e4
LT		 50#include <linux/module.h>
51#include <linux/pci.h>
682d4c80 52#include <linux/dma-mapping.h>
1da177e4
LT		 53#include <linux/kernel.h>
54#include <linux/delay.h>
55#include <linux/ioport.h>
56#include <linux/sched.h>
57#include <linux/slab.h>
58#include <linux/smp_lock.h>
59#include <linux/errno.h>
60#include <linux/init.h>
61#include <linux/timer.h>
62#include <linux/list.h>
63#include <linux/interrupt.h>
64#include <linux/moduleparam.h>
65#include <linux/device.h>
66#include <linux/usb_ch9.h>
67#include <linux/usb_gadget.h>
68
69#include <asm/byteorder.h>
70#include <asm/io.h>
71#include <asm/irq.h>
72#include <asm/system.h>
73#include <asm/unaligned.h>
74
75
950ee4c8
GL		 76#define DRIVER_DESC "PLX NET228x USB Peripheral Controller"
77#define DRIVER_VERSION "2005 Sept 27"
1da177e4
LT		 78
79#define DMA_ADDR_INVALID (~(dma_addr_t)0)
80#define EP_DONTUSE 13 /* nonzero */
81
82#define USE_RDK_LEDS /* GPIO pins control three LEDs */
83
84
85static const char driver_name [] = "net2280";
86static const char driver_desc [] = DRIVER_DESC;
87
88static const char ep0name [] = "ep0";
901b3d75 89static const char *const ep_name [] = {
1da177e4
LT		 90 ep0name,
91 "ep-a", "ep-b", "ep-c", "ep-d",
92 "ep-e", "ep-f",
93};
94
95/* use_dma -- general goodness, fewer interrupts, less cpu load (vs PIO)
96 * use_dma_chaining -- dma descriptor queueing gives even more irq reduction
97 *
98 * The net2280 DMA engines are not tightly integrated with their FIFOs;
99 * not all cases are (yet) handled well in this driver or the silicon.
100 * Some gadget drivers work better with the dma support here than others.
101 * These two parameters let you use PIO or more aggressive DMA.
102 */
103static int use_dma = 1;
104static int use_dma_chaining = 0;
105
106/* "modprobe net2280 use_dma=n" etc */
107module_param (use_dma, bool, S_IRUGO);
108module_param (use_dma_chaining, bool, S_IRUGO);
109
110
111/* mode 0 == ep-{a,b,c,d} 1K fifo each
112 * mode 1 == ep-{a,b} 2K fifo each, ep-{c,d} unavailable
113 * mode 2 == ep-a 2K fifo, ep-{b,c} 1K each, ep-d unavailable
114 */
115static ushort fifo_mode = 0;
116
117/* "modprobe net2280 fifo_mode=1" etc */
118module_param (fifo_mode, ushort, 0644);
119
120/* enable_suspend -- When enabled, the driver will respond to
121 * USB suspend requests by powering down the NET2280. Otherwise,
122 * USB suspend requests will be ignored. This is acceptible for
950ee4c8 123 * self-powered devices
1da177e4
LT		 124 */
125static int enable_suspend = 0;
126
127/* "modprobe net2280 enable_suspend=1" etc */
128module_param (enable_suspend, bool, S_IRUGO);
129
130
131#define DIR_STRING(bAddress) (((bAddress) & USB_DIR_IN) ? "in" : "out")
132
133#if defined(CONFIG_USB_GADGET_DEBUG_FILES) || defined (DEBUG)
134static char *type_string (u8 bmAttributes)
135{
136 switch ((bmAttributes) & USB_ENDPOINT_XFERTYPE_MASK) {
137 case USB_ENDPOINT_XFER_BULK: return "bulk";
138 case USB_ENDPOINT_XFER_ISOC: return "iso";
139 case USB_ENDPOINT_XFER_INT: return "intr";
140 };
141 return "control";
142}
143#endif
144
145#include "net2280.h"
146
147#define valid_bit __constant_cpu_to_le32 (1 << VALID_BIT)
148#define dma_done_ie __constant_cpu_to_le32 (1 << DMA_DONE_INTERRUPT_ENABLE)
149
150/*-------------------------------------------------------------------------*/
151
152static int
153net2280_enable (struct usb_ep *_ep, const struct usb_endpoint_descriptor *desc)
154{
155 struct net2280 *dev;
156 struct net2280_ep *ep;
157 u32 max, tmp;
158 unsigned long flags;
159
160 ep = container_of (_ep, struct net2280_ep, ep);
161 if (!_ep || !desc || ep->desc || _ep->name == ep0name
162 || desc->bDescriptorType != USB_DT_ENDPOINT)
163 return -EINVAL;
164 dev = ep->dev;
165 if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN)
166 return -ESHUTDOWN;
167
168 /* erratum 0119 workaround ties up an endpoint number */
169 if ((desc->bEndpointAddress & 0x0f) == EP_DONTUSE)
170 return -EDOM;
171
172 /* sanity check ep-e/ep-f since their fifos are small */
173 max = le16_to_cpu (desc->wMaxPacketSize) & 0x1fff;
174 if (ep->num > 4 && max > 64)
175 return -ERANGE;
176
177 spin_lock_irqsave (&dev->lock, flags);
178 _ep->maxpacket = max & 0x7ff;
179 ep->desc = desc;
180
181 /* ep_reset() has already been called */
182 ep->stopped = 0;
183 ep->out_overflow = 0;
184
185 /* set speed-dependent max packet; may kick in high bandwidth */
186 set_idx_reg (dev->regs, REG_EP_MAXPKT (dev, ep->num), max);
187
188 /* FIFO lines can't go to different packets. PIO is ok, so
189 * use it instead of troublesome (non-bulk) multi-packet DMA.
190 */
191 if (ep->dma && (max % 4) != 0 && use_dma_chaining) {
192 DEBUG (ep->dev, "%s, no dma for maxpacket %d\n",
193 ep->ep.name, ep->ep.maxpacket);
194 ep->dma = NULL;
195 }
196
197 /* set type, direction, address; reset fifo counters */
198 writel ((1 << FIFO_FLUSH), &ep->regs->ep_stat);
199 tmp = (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK);
200 if (tmp == USB_ENDPOINT_XFER_INT) {
201 /* erratum 0105 workaround prevents hs NYET */
202 if (dev->chiprev == 0100
203 && dev->gadget.speed == USB_SPEED_HIGH
204 && !(desc->bEndpointAddress & USB_DIR_IN))
205 writel ((1 << CLEAR_NAK_OUT_PACKETS_MODE),
206 &ep->regs->ep_rsp);
207 } else if (tmp == USB_ENDPOINT_XFER_BULK) {
208 /* catch some particularly blatant driver bugs */
209 if ((dev->gadget.speed == USB_SPEED_HIGH
210 && max != 512)
211 || (dev->gadget.speed == USB_SPEED_FULL
212 && max > 64)) {
213 spin_unlock_irqrestore (&dev->lock, flags);
214 return -ERANGE;
215 }
216 }
217 ep->is_iso = (tmp == USB_ENDPOINT_XFER_ISOC) ? 1 : 0;
218 tmp <<= ENDPOINT_TYPE;
219 tmp |= desc->bEndpointAddress;
220 tmp |= (4 << ENDPOINT_BYTE_COUNT); /* default full fifo lines */
221 tmp |= 1 << ENDPOINT_ENABLE;
222 wmb ();
223
224 /* for OUT transfers, block the rx fifo until a read is posted */
225 ep->is_in = (tmp & USB_DIR_IN) != 0;
226 if (!ep->is_in)
227 writel ((1 << SET_NAK_OUT_PACKETS), &ep->regs->ep_rsp);
950ee4c8 228 else if (dev->pdev->device != 0x2280) {
901b3d75
DB		 229 /* Added for 2282, Don't use nak packets on an in endpoint,
230 * this was ignored on 2280
231 */
950ee4c8
GL		 232 writel ((1 << CLEAR_NAK_OUT_PACKETS)
233 | (1 << CLEAR_NAK_OUT_PACKETS_MODE), &ep->regs->ep_rsp);
234 }
1da177e4
LT		 235
236 writel (tmp, &ep->regs->ep_cfg);
237
238 /* enable irqs */
239 if (!ep->dma) { /* pio, per-packet */
240 tmp = (1 << ep->num) | readl (&dev->regs->pciirqenb0);
241 writel (tmp, &dev->regs->pciirqenb0);
242
243 tmp = (1 << DATA_PACKET_RECEIVED_INTERRUPT_ENABLE)
950ee4c8
GL		 244 | (1 << DATA_PACKET_TRANSMITTED_INTERRUPT_ENABLE);
245 if (dev->pdev->device == 0x2280)
246 tmp |= readl (&ep->regs->ep_irqenb);
1da177e4
LT		 247 writel (tmp, &ep->regs->ep_irqenb);
248 } else { /* dma, per-request */
249 tmp = (1 << (8 + ep->num)); /* completion */
250 tmp |= readl (&dev->regs->pciirqenb1);
251 writel (tmp, &dev->regs->pciirqenb1);
252
253 /* for short OUT transfers, dma completions can't
254 * advance the queue; do it pio-style, by hand.
255 * NOTE erratum 0112 workaround #2
256 */
257 if ((desc->bEndpointAddress & USB_DIR_IN) == 0) {
258 tmp = (1 << SHORT_PACKET_TRANSFERRED_INTERRUPT_ENABLE);
259 writel (tmp, &ep->regs->ep_irqenb);
260
261 tmp = (1 << ep->num) | readl (&dev->regs->pciirqenb0);
262 writel (tmp, &dev->regs->pciirqenb0);
263 }
264 }
265
266 tmp = desc->bEndpointAddress;
267 DEBUG (dev, "enabled %s (ep%d%s-%s) %s max %04x\n",
268 _ep->name, tmp & 0x0f, DIR_STRING (tmp),
269 type_string (desc->bmAttributes),
270 ep->dma ? "dma" : "pio", max);
271
272 /* pci writes may still be posted */
273 spin_unlock_irqrestore (&dev->lock, flags);
274 return 0;
275}
276
277static int handshake (u32 __iomem *ptr, u32 mask, u32 done, int usec)
278{
279 u32 result;
280
281 do {
282 result = readl (ptr);
283 if (result == ~(u32)0) /* "device unplugged" */
284 return -ENODEV;
285 result &= mask;
286 if (result == done)
287 return 0;
288 udelay (1);
289 usec--;
290 } while (usec > 0);
291 return -ETIMEDOUT;
292}
293
901b3d75 294static const struct usb_ep_ops net2280_ep_ops;
1da177e4
LT		 295
296static void ep_reset (struct net2280_regs __iomem *regs, struct net2280_ep *ep)
297{
298 u32 tmp;
299
300 ep->desc = NULL;
301 INIT_LIST_HEAD (&ep->queue);
302
303 ep->ep.maxpacket = ~0;
304 ep->ep.ops = &net2280_ep_ops;
305
306 /* disable the dma, irqs, endpoint... */
307 if (ep->dma) {
308 writel (0, &ep->dma->dmactl);
309 writel ( (1 << DMA_SCATTER_GATHER_DONE_INTERRUPT)
310 | (1 << DMA_TRANSACTION_DONE_INTERRUPT)
311 | (1 << DMA_ABORT)
312 , &ep->dma->dmastat);
313
314 tmp = readl (&regs->pciirqenb0);
315 tmp &= ~(1 << ep->num);
316 writel (tmp, &regs->pciirqenb0);
317 } else {
318 tmp = readl (&regs->pciirqenb1);
319 tmp &= ~(1 << (8 + ep->num)); /* completion */
320 writel (tmp, &regs->pciirqenb1);
321 }
322 writel (0, &ep->regs->ep_irqenb);
323
324 /* init to our chosen defaults, notably so that we NAK OUT
325 * packets until the driver queues a read (+note erratum 0112)
326 */
950ee4c8
GL		 327 if (!ep->is_in || ep->dev->pdev->device == 0x2280) {
328 tmp = (1 << SET_NAK_OUT_PACKETS_MODE)
1da177e4
LT		 329 | (1 << SET_NAK_OUT_PACKETS)
330 | (1 << CLEAR_EP_HIDE_STATUS_PHASE)
331 | (1 << CLEAR_INTERRUPT_MODE);
950ee4c8
GL		 332 } else {
333 /* added for 2282 */
334 tmp = (1 << CLEAR_NAK_OUT_PACKETS_MODE)
335 | (1 << CLEAR_NAK_OUT_PACKETS)
336 | (1 << CLEAR_EP_HIDE_STATUS_PHASE)
337 | (1 << CLEAR_INTERRUPT_MODE);
338 }
1da177e4
LT		 339
340 if (ep->num != 0) {
341 tmp |= (1 << CLEAR_ENDPOINT_TOGGLE)
342 | (1 << CLEAR_ENDPOINT_HALT);
343 }
344 writel (tmp, &ep->regs->ep_rsp);
345
346 /* scrub most status bits, and flush any fifo state */
950ee4c8
GL		 347 if (ep->dev->pdev->device == 0x2280)
348 tmp = (1 << FIFO_OVERFLOW)
349 | (1 << FIFO_UNDERFLOW);
350 else
351 tmp = 0;
352
353 writel (tmp | (1 << TIMEOUT)
1da177e4
LT		 354 | (1 << USB_STALL_SENT)
355 | (1 << USB_IN_NAK_SENT)
356 | (1 << USB_IN_ACK_RCVD)
357 | (1 << USB_OUT_PING_NAK_SENT)
358 | (1 << USB_OUT_ACK_SENT)
1da177e4
LT		 359 | (1 << FIFO_FLUSH)
360 | (1 << SHORT_PACKET_OUT_DONE_INTERRUPT)
361 | (1 << SHORT_PACKET_TRANSFERRED_INTERRUPT)
362 | (1 << DATA_PACKET_RECEIVED_INTERRUPT)
363 | (1 << DATA_PACKET_TRANSMITTED_INTERRUPT)
364 | (1 << DATA_OUT_PING_TOKEN_INTERRUPT)
365 | (1 << DATA_IN_TOKEN_INTERRUPT)
366 , &ep->regs->ep_stat);
367
368 /* fifo size is handled separately */
369}
370
371static void nuke (struct net2280_ep *);
372
373static int net2280_disable (struct usb_ep *_ep)
374{
375 struct net2280_ep *ep;
376 unsigned long flags;
377
378 ep = container_of (_ep, struct net2280_ep, ep);
379 if (!_ep || !ep->desc || _ep->name == ep0name)
380 return -EINVAL;
381
382 spin_lock_irqsave (&ep->dev->lock, flags);
383 nuke (ep);
384 ep_reset (ep->dev->regs, ep);
385
386 VDEBUG (ep->dev, "disabled %s %s\n",
387 ep->dma ? "dma" : "pio", _ep->name);
388
389 /* synch memory views with the device */
390 (void) readl (&ep->regs->ep_cfg);
391
392 if (use_dma && !ep->dma && ep->num >= 1 && ep->num <= 4)
393 ep->dma = &ep->dev->dma [ep->num - 1];
394
395 spin_unlock_irqrestore (&ep->dev->lock, flags);
396 return 0;
397}
398
399/*-------------------------------------------------------------------------*/
400
401static struct usb_request *
55016f10 402net2280_alloc_request (struct usb_ep *_ep, gfp_t gfp_flags)
1da177e4
LT		 403{
404 struct net2280_ep *ep;
405 struct net2280_request *req;
406
407 if (!_ep)
408 return NULL;
409 ep = container_of (_ep, struct net2280_ep, ep);
410
7039f422 411 req = kzalloc(sizeof(*req), gfp_flags);
1da177e4
LT		 412 if (!req)
413 return NULL;
414
1da177e4
LT		 415 req->req.dma = DMA_ADDR_INVALID;
416 INIT_LIST_HEAD (&req->queue);
417
418 /* this dma descriptor may be swapped with the previous dummy */
419 if (ep->dma) {
420 struct net2280_dma *td;
421
422 td = pci_pool_alloc (ep->dev->requests, gfp_flags,
423 &req->td_dma);
424 if (!td) {
425 kfree (req);
426 return NULL;
427 }
428 td->dmacount = 0; /* not VALID */
429 td->dmaaddr = __constant_cpu_to_le32 (DMA_ADDR_INVALID);
430 td->dmadesc = td->dmaaddr;
431 req->td = td;
432 }
433 return &req->req;
434}
435
436static void
437net2280_free_request (struct usb_ep *_ep, struct usb_request *_req)
438{
439 struct net2280_ep *ep;
440 struct net2280_request *req;
441
442 ep = container_of (_ep, struct net2280_ep, ep);
443 if (!_ep || !_req)
444 return;
445
446 req = container_of (_req, struct net2280_request, req);
447 WARN_ON (!list_empty (&req->queue));
448 if (req->td)
449 pci_pool_free (ep->dev->requests, req->td, req->td_dma);
450 kfree (req);
451}
452
453/*-------------------------------------------------------------------------*/
454
901b3d75
DB		 455/*
456 * dma-coherent memory allocation (for dma-capable endpoints)
1da177e4 457 *
901b3d75
DB		 458 * NOTE: the dma_*_coherent() API calls suck. Most implementations are
459 * (a) page-oriented, so small buffers lose big; and (b) asymmetric with
460 * respect to calls with irqs disabled: alloc is safe, free is not.
461 * We currently work around (b), but not (a).
1da177e4 462 */
1da177e4 463
1da177e4
LT		 464static void *
465net2280_alloc_buffer (
466 struct usb_ep *_ep,
467 unsigned bytes,
468 dma_addr_t *dma,
55016f10 469 gfp_t gfp_flags
1da177e4
LT		 470)
471{
472 void *retval;
473 struct net2280_ep *ep;
474
475 ep = container_of (_ep, struct net2280_ep, ep);
476 if (!_ep)
477 return NULL;
478 *dma = DMA_ADDR_INVALID;
479
901b3d75 480 if (ep->dma)
1da177e4
LT		 481 retval = dma_alloc_coherent(&ep->dev->pdev->dev,
482 bytes, dma, gfp_flags);
901b3d75 483 else
1da177e4 484 retval = kmalloc(bytes, gfp_flags);
1da177e4
LT		 485 return retval;
486}
487
901b3d75
DB		 488static DEFINE_SPINLOCK(buflock);
489static LIST_HEAD(buffers);
490
491struct free_record {
492 struct list_head list;
493 struct device *dev;
494 unsigned bytes;
495 dma_addr_t dma;
496};
497
498static void do_free(unsigned long ignored)
499{
500 spin_lock_irq(&buflock);
501 while (!list_empty(&buffers)) {
502 struct free_record *buf;
503
504 buf = list_entry(buffers.next, struct free_record, list);
505 list_del(&buf->list);
506 spin_unlock_irq(&buflock);
507
508 dma_free_coherent(buf->dev, buf->bytes, buf, buf->dma);
509
510 spin_lock_irq(&buflock);
511 }
512 spin_unlock_irq(&buflock);
513}
514
515static DECLARE_TASKLET(deferred_free, do_free, 0);
516
1da177e4
LT		 517static void
518net2280_free_buffer (
519 struct usb_ep *_ep,
901b3d75 520 void *address,
1da177e4
LT		 521 dma_addr_t dma,
522 unsigned bytes
523) {
524 /* free memory into the right allocator */
1da177e4
LT		 525 if (dma != DMA_ADDR_INVALID) {
526 struct net2280_ep *ep;
901b3d75
DB		 527 struct free_record *buf = address;
528 unsigned long flags;
1da177e4
LT		 529
530 ep = container_of(_ep, struct net2280_ep, ep);
531 if (!_ep)
532 return;
901b3d75
DB		 533
534 ep = container_of (_ep, struct net2280_ep, ep);
535 buf->dev = &ep->dev->pdev->dev;
536 buf->bytes = bytes;
537 buf->dma = dma;
538
539 spin_lock_irqsave(&buflock, flags);
540 list_add_tail(&buf->list, &buffers);
541 tasklet_schedule(&deferred_free);
542 spin_unlock_irqrestore(&buflock, flags);
1da177e4 543 } else
901b3d75 544 kfree (address);
1da177e4
LT		 545}
546
547/*-------------------------------------------------------------------------*/
548
549/* load a packet into the fifo we use for usb IN transfers.
550 * works for all endpoints.
551 *
552 * NOTE: pio with ep-a..ep-d could stuff multiple packets into the fifo
553 * at a time, but this code is simpler because it knows it only writes
554 * one packet. ep-a..ep-d should use dma instead.
555 */
556static void
557write_fifo (struct net2280_ep *ep, struct usb_request *req)
558{
559 struct net2280_ep_regs __iomem *regs = ep->regs;
560 u8 *buf;
561 u32 tmp;
562 unsigned count, total;
563
564 /* INVARIANT: fifo is currently empty. (testable) */
565
566 if (req) {
567 buf = req->buf + req->actual;
568 prefetch (buf);
569 total = req->length - req->actual;
570 } else {
571 total = 0;
572 buf = NULL;
573 }
574
575 /* write just one packet at a time */
576 count = ep->ep.maxpacket;
577 if (count > total) /* min() cannot be used on a bitfield */
578 count = total;
579
580 VDEBUG (ep->dev, "write %s fifo (IN) %d bytes%s req %p\n",
581 ep->ep.name, count,
582 (count != ep->ep.maxpacket) ? " (short)" : "",
583 req);
584 while (count >= 4) {
585 /* NOTE be careful if you try to align these. fifo lines
586 * should normally be full (4 bytes) and successive partial
587 * lines are ok only in certain cases.
588 */
589 tmp = get_unaligned ((u32 *)buf);
590 cpu_to_le32s (&tmp);
591 writel (tmp, &regs->ep_data);
592 buf += 4;
593 count -= 4;
594 }
595
596 /* last fifo entry is "short" unless we wrote a full packet.
597 * also explicitly validate last word in (periodic) transfers
598 * when maxpacket is not a multiple of 4 bytes.
599 */
600 if (count || total < ep->ep.maxpacket) {
601 tmp = count ? get_unaligned ((u32 *)buf) : count;
602 cpu_to_le32s (&tmp);
603 set_fifo_bytecount (ep, count & 0x03);
604 writel (tmp, &regs->ep_data);
605 }
606
607 /* pci writes may still be posted */
608}
609
610/* work around erratum 0106: PCI and USB race over the OUT fifo.
611 * caller guarantees chiprev 0100, out endpoint is NAKing, and
612 * there's no real data in the fifo.
613 *
614 * NOTE: also used in cases where that erratum doesn't apply:
615 * where the host wrote "too much" data to us.
616 */
617static void out_flush (struct net2280_ep *ep)
618{
619 u32 __iomem *statp;
620 u32 tmp;
621
622 ASSERT_OUT_NAKING (ep);
623
624 statp = &ep->regs->ep_stat;
625 writel ( (1 << DATA_OUT_PING_TOKEN_INTERRUPT)
626 | (1 << DATA_PACKET_RECEIVED_INTERRUPT)
627 , statp);
628 writel ((1 << FIFO_FLUSH), statp);
629 mb ();
630 tmp = readl (statp);
631 if (tmp & (1 << DATA_OUT_PING_TOKEN_INTERRUPT)
632 /* high speed did bulk NYET; fifo isn't filling */
633 && ep->dev->gadget.speed == USB_SPEED_FULL) {
634 unsigned usec;
635
636 usec = 50; /* 64 byte bulk/interrupt */
637 handshake (statp, (1 << USB_OUT_PING_NAK_SENT),
638 (1 << USB_OUT_PING_NAK_SENT), usec);
639 /* NAK done; now CLEAR_NAK_OUT_PACKETS is safe */
640 }
641}
642
643/* unload packet(s) from the fifo we use for usb OUT transfers.
644 * returns true iff the request completed, because of short packet
645 * or the request buffer having filled with full packets.
646 *
647 * for ep-a..ep-d this will read multiple packets out when they
648 * have been accepted.
649 */
650static int
651read_fifo (struct net2280_ep *ep, struct net2280_request *req)
652{
653 struct net2280_ep_regs __iomem *regs = ep->regs;
654 u8 *buf = req->req.buf + req->req.actual;
655 unsigned count, tmp, is_short;
656 unsigned cleanup = 0, prevent = 0;
657
658 /* erratum 0106 ... packets coming in during fifo reads might
659 * be incompletely rejected. not all cases have workarounds.
660 */
661 if (ep->dev->chiprev == 0x0100
662 && ep->dev->gadget.speed == USB_SPEED_FULL) {
663 udelay (1);
664 tmp = readl (&ep->regs->ep_stat);
665 if ((tmp & (1 << NAK_OUT_PACKETS)))
666 cleanup = 1;
667 else if ((tmp & (1 << FIFO_FULL))) {
668 start_out_naking (ep);
669 prevent = 1;
670 }
671 /* else: hope we don't see the problem */
672 }
673
674 /* never overflow the rx buffer. the fifo reads packets until
675 * it sees a short one; we might not be ready for them all.
676 */
677 prefetchw (buf);
678 count = readl (&regs->ep_avail);
679 if (unlikely (count == 0)) {
680 udelay (1);
681 tmp = readl (&ep->regs->ep_stat);
682 count = readl (&regs->ep_avail);
683 /* handled that data already? */
684 if (count == 0 && (tmp & (1 << NAK_OUT_PACKETS)) == 0)
685 return 0;
686 }
687
688 tmp = req->req.length - req->req.actual;
689 if (count > tmp) {
690 /* as with DMA, data overflow gets flushed */
691 if ((tmp % ep->ep.maxpacket) != 0) {
692 ERROR (ep->dev,
693 "%s out fifo %d bytes, expected %d\n",
694 ep->ep.name, count, tmp);
695 req->req.status = -EOVERFLOW;
696 cleanup = 1;
697 /* NAK_OUT_PACKETS will be set, so flushing is safe;
698 * the next read will start with the next packet
699 */
700 } /* else it's a ZLP, no worries */
701 count = tmp;
702 }
703 req->req.actual += count;
704
705 is_short = (count == 0) || ((count % ep->ep.maxpacket) != 0);
706
707 VDEBUG (ep->dev, "read %s fifo (OUT) %d bytes%s%s%s req %p %d/%d\n",
708 ep->ep.name, count, is_short ? " (short)" : "",
709 cleanup ? " flush" : "", prevent ? " nak" : "",
710 req, req->req.actual, req->req.length);
711
712 while (count >= 4) {
713 tmp = readl (&regs->ep_data);
714 cpu_to_le32s (&tmp);
715 put_unaligned (tmp, (u32 *)buf);
716 buf += 4;
717 count -= 4;
718 }
719 if (count) {
720 tmp = readl (&regs->ep_data);
721 /* LE conversion is implicit here: */
722 do {
723 *buf++ = (u8) tmp;
724 tmp >>= 8;
725 } while (--count);
726 }
727 if (cleanup)
728 out_flush (ep);
729 if (prevent) {
730 writel ((1 << CLEAR_NAK_OUT_PACKETS), &ep->regs->ep_rsp);
731 (void) readl (&ep->regs->ep_rsp);
732 }
733
734 return is_short || ((req->req.actual == req->req.length)
735 && !req->req.zero);
736}
737
738/* fill out dma descriptor to match a given request */
739static void
740fill_dma_desc (struct net2280_ep *ep, struct net2280_request *req, int valid)
741{
742 struct net2280_dma *td = req->td;
743 u32 dmacount = req->req.length;
744
745 /* don't let DMA continue after a short OUT packet,
746 * so overruns can't affect the next transfer.
747 * in case of overruns on max-size packets, we can't
748 * stop the fifo from filling but we can flush it.
749 */
750 if (ep->is_in)
751 dmacount |= (1 << DMA_DIRECTION);
901b3d75
DB		 752 if ((!ep->is_in && (dmacount % ep->ep.maxpacket) != 0)
753 || ep->dev->pdev->device != 0x2280)
1da177e4
LT		 754 dmacount |= (1 << END_OF_CHAIN);
755
756 req->valid = valid;
757 if (valid)
758 dmacount |= (1 << VALID_BIT);
759 if (likely(!req->req.no_interrupt || !use_dma_chaining))
760 dmacount |= (1 << DMA_DONE_INTERRUPT_ENABLE);
761
762 /* td->dmadesc = previously set by caller */
763 td->dmaaddr = cpu_to_le32 (req->req.dma);
764
765 /* 2280 may be polling VALID_BIT through ep->dma->dmadesc */
766 wmb ();
767 td->dmacount = cpu_to_le32p (&dmacount);
768}
769
770static const u32 dmactl_default =
771 (1 << DMA_SCATTER_GATHER_DONE_INTERRUPT)
772 | (1 << DMA_CLEAR_COUNT_ENABLE)
773 /* erratum 0116 workaround part 1 (use POLLING) */
774 | (POLL_100_USEC << DESCRIPTOR_POLLING_RATE)
775 | (1 << DMA_VALID_BIT_POLLING_ENABLE)
776 | (1 << DMA_VALID_BIT_ENABLE)
777 | (1 << DMA_SCATTER_GATHER_ENABLE)
778 /* erratum 0116 workaround part 2 (no AUTOSTART) */
779 | (1 << DMA_ENABLE);
780
781static inline void spin_stop_dma (struct net2280_dma_regs __iomem *dma)
782{
783 handshake (&dma->dmactl, (1 << DMA_ENABLE), 0, 50);
784}
785
786static inline void stop_dma (struct net2280_dma_regs __iomem *dma)
787{
788 writel (readl (&dma->dmactl) & ~(1 << DMA_ENABLE), &dma->dmactl);
789 spin_stop_dma (dma);
790}
791
792static void start_queue (struct net2280_ep *ep, u32 dmactl, u32 td_dma)
793{
794 struct net2280_dma_regs __iomem *dma = ep->dma;
950ee4c8 795 unsigned int tmp = (1 << VALID_BIT) | (ep->is_in << DMA_DIRECTION);
1da177e4 796
950ee4c8
GL		 797 if (ep->dev->pdev->device != 0x2280)
798 tmp |= (1 << END_OF_CHAIN);
799
800 writel (tmp, &dma->dmacount);
1da177e4
LT		 801 writel (readl (&dma->dmastat), &dma->dmastat);
802
803 writel (td_dma, &dma->dmadesc);
804 writel (dmactl, &dma->dmactl);
805
806 /* erratum 0116 workaround part 3: pci arbiter away from net2280 */
807 (void) readl (&ep->dev->pci->pcimstctl);
808
809 writel ((1 << DMA_START), &dma->dmastat);
810
811 if (!ep->is_in)
812 stop_out_naking (ep);
813}
814
815static void start_dma (struct net2280_ep *ep, struct net2280_request *req)
816{
817 u32 tmp;
818 struct net2280_dma_regs __iomem *dma = ep->dma;
819
820 /* FIXME can't use DMA for ZLPs */
821
822 /* on this path we "know" there's no dma active (yet) */
823 WARN_ON (readl (&dma->dmactl) & (1 << DMA_ENABLE));
824 writel (0, &ep->dma->dmactl);
825
826 /* previous OUT packet might have been short */
827 if (!ep->is_in && ((tmp = readl (&ep->regs->ep_stat))
901b3d75 828 & (1 << NAK_OUT_PACKETS)) != 0) {
1da177e4
LT		 829 writel ((1 << SHORT_PACKET_TRANSFERRED_INTERRUPT),
830 &ep->regs->ep_stat);
831
832 tmp = readl (&ep->regs->ep_avail);
833 if (tmp) {
834 writel (readl (&dma->dmastat), &dma->dmastat);
835
836 /* transfer all/some fifo data */
837 writel (req->req.dma, &dma->dmaaddr);
838 tmp = min (tmp, req->req.length);
839
840 /* dma irq, faking scatterlist status */
841 req->td->dmacount = cpu_to_le32 (req->req.length - tmp);
842 writel ((1 << DMA_DONE_INTERRUPT_ENABLE)
843 | tmp, &dma->dmacount);
844 req->td->dmadesc = 0;
845 req->valid = 1;
846
847 writel ((1 << DMA_ENABLE), &dma->dmactl);
848 writel ((1 << DMA_START), &dma->dmastat);
849 return;
850 }
851 }
852
853 tmp = dmactl_default;
854
855 /* force packet boundaries between dma requests, but prevent the
856 * controller from automagically writing a last "short" packet
857 * (zero length) unless the driver explicitly said to do that.
858 */
859 if (ep->is_in) {
860 if (likely ((req->req.length % ep->ep.maxpacket) != 0
861 || req->req.zero)) {
862 tmp |= (1 << DMA_FIFO_VALIDATE);
863 ep->in_fifo_validate = 1;
864 } else
865 ep->in_fifo_validate = 0;
866 }
867
868 /* init req->td, pointing to the current dummy */
869 req->td->dmadesc = cpu_to_le32 (ep->td_dma);
870 fill_dma_desc (ep, req, 1);
871
872 if (!use_dma_chaining)
873 req->td->dmacount |= __constant_cpu_to_le32 (1 << END_OF_CHAIN);
874
875 start_queue (ep, tmp, req->td_dma);
876}
877
878static inline void
879queue_dma (struct net2280_ep *ep, struct net2280_request *req, int valid)
880{
881 struct net2280_dma *end;
882 dma_addr_t tmp;
883
884 /* swap new dummy for old, link; fill and maybe activate */
885 end = ep->dummy;
886 ep->dummy = req->td;
887 req->td = end;
888
889 tmp = ep->td_dma;
890 ep->td_dma = req->td_dma;
891 req->td_dma = tmp;
892
893 end->dmadesc = cpu_to_le32 (ep->td_dma);
894
895 fill_dma_desc (ep, req, valid);
896}
897
898static void
899done (struct net2280_ep *ep, struct net2280_request *req, int status)
900{
901 struct net2280 *dev;
902 unsigned stopped = ep->stopped;
903
904 list_del_init (&req->queue);
905
906 if (req->req.status == -EINPROGRESS)
907 req->req.status = status;
908 else
909 status = req->req.status;
910
911 dev = ep->dev;
912 if (req->mapped) {
913 pci_unmap_single (dev->pdev, req->req.dma, req->req.length,
914 ep->is_in ? PCI_DMA_TODEVICE : PCI_DMA_FROMDEVICE);
915 req->req.dma = DMA_ADDR_INVALID;
916 req->mapped = 0;
917 }
918
919 if (status && status != -ESHUTDOWN)
920 VDEBUG (dev, "complete %s req %p stat %d len %u/%u\n",
921 ep->ep.name, &req->req, status,
922 req->req.actual, req->req.length);
923
924 /* don't modify queue heads during completion callback */
925 ep->stopped = 1;
926 spin_unlock (&dev->lock);
927 req->req.complete (&ep->ep, &req->req);
928 spin_lock (&dev->lock);
929 ep->stopped = stopped;
930}
931
932/*-------------------------------------------------------------------------*/
933
934static int
55016f10 935net2280_queue (struct usb_ep *_ep, struct usb_request *_req, gfp_t gfp_flags)
1da177e4
LT		 936{
937 struct net2280_request *req;
938 struct net2280_ep *ep;
939 struct net2280 *dev;
940 unsigned long flags;
941
942 /* we always require a cpu-view buffer, so that we can
943 * always use pio (as fallback or whatever).
944 */
945 req = container_of (_req, struct net2280_request, req);
946 if (!_req || !_req->complete || !_req->buf
947 || !list_empty (&req->queue))
948 return -EINVAL;
949 if (_req->length > (~0 & DMA_BYTE_COUNT_MASK))
950 return -EDOM;
951 ep = container_of (_ep, struct net2280_ep, ep);
952 if (!_ep || (!ep->desc && ep->num != 0))
953 return -EINVAL;
954 dev = ep->dev;
955 if (!dev->driver || dev->gadget.speed == USB_SPEED_UNKNOWN)
956 return -ESHUTDOWN;
957
958 /* FIXME implement PIO fallback for ZLPs with DMA */
959 if (ep->dma && _req->length == 0)
960 return -EOPNOTSUPP;
961
962 /* set up dma mapping in case the caller didn't */
963 if (ep->dma && _req->dma == DMA_ADDR_INVALID) {
964 _req->dma = pci_map_single (dev->pdev, _req->buf, _req->length,
965 ep->is_in ? PCI_DMA_TODEVICE : PCI_DMA_FROMDEVICE);
966 req->mapped = 1;
967 }
968
969#if 0
970 VDEBUG (dev, "%s queue req %p, len %d buf %p\n",
971 _ep->name, _req, _req->length, _req->buf);
972#endif
973
974 spin_lock_irqsave (&dev->lock, flags);
975
976 _req->status = -EINPROGRESS;
977 _req->actual = 0;
978
979 /* kickstart this i/o queue? */
980 if (list_empty (&ep->queue) && !ep->stopped) {
981 /* use DMA if the endpoint supports it, else pio */
982 if (ep->dma)
983 start_dma (ep, req);
984 else {
985 /* maybe there's no control data, just status ack */
986 if (ep->num == 0 && _req->length == 0) {
987 allow_status (ep);
988 done (ep, req, 0);
989 VDEBUG (dev, "%s status ack\n", ep->ep.name);
990 goto done;
991 }
992
993 /* PIO ... stuff the fifo, or unblock it. */
994 if (ep->is_in)
995 write_fifo (ep, _req);
996 else if (list_empty (&ep->queue)) {
997 u32 s;
998
999 /* OUT FIFO might have packet(s) buffered */
1000 s = readl (&ep->regs->ep_stat);
1001 if ((s & (1 << FIFO_EMPTY)) == 0) {
1002 /* note: _req->short_not_ok is
1003 * ignored here since PIO _always_
1004 * stops queue advance here, and
1005 * _req->status doesn't change for
1006 * short reads (only _req->actual)
1007 */
1008 if (read_fifo (ep, req)) {
1009 done (ep, req, 0);
1010 if (ep->num == 0)
1011 allow_status (ep);
1012 /* don't queue it */
1013 req = NULL;
1014 } else
1015 s = readl (&ep->regs->ep_stat);
1016 }
1017
1018 /* don't NAK, let the fifo fill */
1019 if (req && (s & (1 << NAK_OUT_PACKETS)))
1020 writel ((1 << CLEAR_NAK_OUT_PACKETS),
1021 &ep->regs->ep_rsp);
1022 }
1023 }
1024
1025 } else if (ep->dma) {
1026 int valid = 1;
1027
1028 if (ep->is_in) {
1029 int expect;
1030
1031 /* preventing magic zlps is per-engine state, not
1032 * per-transfer; irq logic must recover hiccups.
1033 */
1034 expect = likely (req->req.zero
1035 || (req->req.length % ep->ep.maxpacket) != 0);
1036 if (expect != ep->in_fifo_validate)
1037 valid = 0;
1038 }
1039 queue_dma (ep, req, valid);
1040
1041 } /* else the irq handler advances the queue. */
1042
1f26e28d 1043 ep->responded = 1;
1da177e4
LT		 1044 if (req)
1045 list_add_tail (&req->queue, &ep->queue);
1046done:
1047 spin_unlock_irqrestore (&dev->lock, flags);
1048
1049 /* pci writes may still be posted */
1050 return 0;
1051}
1052
1053static inline void
1054dma_done (
1055 struct net2280_ep *ep,
1056 struct net2280_request *req,
1057 u32 dmacount,
1058 int status
1059)
1060{
1061 req->req.actual = req->req.length - (DMA_BYTE_COUNT_MASK & dmacount);
1062 done (ep, req, status);
1063}
1064
1065static void restart_dma (struct net2280_ep *ep);
1066
1067static void scan_dma_completions (struct net2280_ep *ep)
1068{
1069 /* only look at descriptors that were "naturally" retired,
1070 * so fifo and list head state won't matter
1071 */
1072 while (!list_empty (&ep->queue)) {
1073 struct net2280_request *req;
1074 u32 tmp;
1075
1076 req = list_entry (ep->queue.next,
1077 struct net2280_request, queue);
1078 if (!req->valid)
1079 break;
1080 rmb ();
1081 tmp = le32_to_cpup (&req->td->dmacount);
1082 if ((tmp & (1 << VALID_BIT)) != 0)
1083 break;
1084
1085 /* SHORT_PACKET_TRANSFERRED_INTERRUPT handles "usb-short"
1086 * cases where DMA must be aborted; this code handles
1087 * all non-abort DMA completions.
1088 */
1089 if (unlikely (req->td->dmadesc == 0)) {
1090 /* paranoia */
1091 tmp = readl (&ep->dma->dmacount);
1092 if (tmp & DMA_BYTE_COUNT_MASK)
1093 break;
1094 /* single transfer mode */
1095 dma_done (ep, req, tmp, 0);
1096 break;
1097 } else if (!ep->is_in
1098 && (req->req.length % ep->ep.maxpacket) != 0) {
1099 tmp = readl (&ep->regs->ep_stat);
1100
1101 /* AVOID TROUBLE HERE by not issuing short reads from
1102 * your gadget driver. That helps avoids errata 0121,
1103 * 0122, and 0124; not all cases trigger the warning.
1104 */
1105 if ((tmp & (1 << NAK_OUT_PACKETS)) == 0) {
1106 WARN (ep->dev, "%s lost packet sync!\n",
1107 ep->ep.name);
1108 req->req.status = -EOVERFLOW;
1109 } else if ((tmp = readl (&ep->regs->ep_avail)) != 0) {
1110 /* fifo gets flushed later */
1111 ep->out_overflow = 1;
1112 DEBUG (ep->dev, "%s dma, discard %d len %d\n",
1113 ep->ep.name, tmp,
1114 req->req.length);
1115 req->req.status = -EOVERFLOW;
1116 }
1117 }
1118 dma_done (ep, req, tmp, 0);
1119 }
1120}
1121
1122static void restart_dma (struct net2280_ep *ep)
1123{
1124 struct net2280_request *req;
1125 u32 dmactl = dmactl_default;
1126
1127 if (ep->stopped)
1128 return;
1129 req = list_entry (ep->queue.next, struct net2280_request, queue);
1130
1131 if (!use_dma_chaining) {
1132 start_dma (ep, req);
1133 return;
1134 }
1135
1136 /* the 2280 will be processing the queue unless queue hiccups after
1137 * the previous transfer:
1138 * IN: wanted automagic zlp, head doesn't (or vice versa)
1139 * DMA_FIFO_VALIDATE doesn't init from dma descriptors.
1140 * OUT: was "usb-short", we must restart.
1141 */
1142 if (ep->is_in && !req->valid) {
1143 struct net2280_request *entry, *prev = NULL;
1144 int reqmode, done = 0;
1145
1146 DEBUG (ep->dev, "%s dma hiccup td %p\n", ep->ep.name, req->td);
1147 ep->in_fifo_validate = likely (req->req.zero
1148 || (req->req.length % ep->ep.maxpacket) != 0);
1149 if (ep->in_fifo_validate)
1150 dmactl |= (1 << DMA_FIFO_VALIDATE);
1151 list_for_each_entry (entry, &ep->queue, queue) {
320f3459 1152 __le32 dmacount;
1da177e4
LT		 1153
1154 if (entry == req)
1155 continue;
1156 dmacount = entry->td->dmacount;
1157 if (!done) {
1158 reqmode = likely (entry->req.zero
1159 || (entry->req.length
1160 % ep->ep.maxpacket) != 0);
1161 if (reqmode == ep->in_fifo_validate) {
1162 entry->valid = 1;
1163 dmacount |= valid_bit;
1164 entry->td->dmacount = dmacount;
1165 prev = entry;
1166 continue;
1167 } else {
1168 /* force a hiccup */
1169 prev->td->dmacount |= dma_done_ie;
1170 done = 1;
1171 }
1172 }
1173
1174 /* walk the rest of the queue so unlinks behave */
1175 entry->valid = 0;
1176 dmacount &= ~valid_bit;
1177 entry->td->dmacount = dmacount;
1178 prev = entry;
1179 }
1180 }
1181
1182 writel (0, &ep->dma->dmactl);
1183 start_queue (ep, dmactl, req->td_dma);
1184}
1185
1186static void abort_dma (struct net2280_ep *ep)
1187{
1188 /* abort the current transfer */
1189 if (likely (!list_empty (&ep->queue))) {
1190 /* FIXME work around errata 0121, 0122, 0124 */
1191 writel ((1 << DMA_ABORT), &ep->dma->dmastat);
1192 spin_stop_dma (ep->dma);
1193 } else
1194 stop_dma (ep->dma);
1195 scan_dma_completions (ep);
1196}
1197
1198/* dequeue ALL requests */
1199static void nuke (struct net2280_ep *ep)
1200{
1201 struct net2280_request *req;
1202
1203 /* called with spinlock held */
1204 ep->stopped = 1;
1205 if (ep->dma)
1206 abort_dma (ep);
1207 while (!list_empty (&ep->queue)) {
1208 req = list_entry (ep->queue.next,
1209 struct net2280_request,
1210 queue);
1211 done (ep, req, -ESHUTDOWN);
1212 }
1213}
1214
1215/* dequeue JUST ONE request */
1216static int net2280_dequeue (struct usb_ep *_ep, struct usb_request *_req)
1217{
1218 struct net2280_ep *ep;
1219 struct net2280_request *req;
1220 unsigned long flags;
1221 u32 dmactl;
1222 int stopped;
1223
1224 ep = container_of (_ep, struct net2280_ep, ep);
1225 if (!_ep || (!ep->desc && ep->num != 0) || !_req)
1226 return -EINVAL;
1227
1228 spin_lock_irqsave (&ep->dev->lock, flags);
1229 stopped = ep->stopped;
1230
1231 /* quiesce dma while we patch the queue */
1232 dmactl = 0;
1233 ep->stopped = 1;
1234 if (ep->dma) {
1235 dmactl = readl (&ep->dma->dmactl);
1236 /* WARNING erratum 0127 may kick in ... */
1237 stop_dma (ep->dma);
1238 scan_dma_completions (ep);
1239 }
1240
1241 /* make sure it's still queued on this endpoint */
1242 list_for_each_entry (req, &ep->queue, queue) {
1243 if (&req->req == _req)
1244 break;
1245 }
1246 if (&req->req != _req) {
1247 spin_unlock_irqrestore (&ep->dev->lock, flags);
1248 return -EINVAL;
1249 }
1250
1251 /* queue head may be partially complete. */
1252 if (ep->queue.next == &req->queue) {
1253 if (ep->dma) {
1254 DEBUG (ep->dev, "unlink (%s) dma\n", _ep->name);
1255 _req->status = -ECONNRESET;
1256 abort_dma (ep);
1257 if (likely (ep->queue.next == &req->queue)) {
1258 // NOTE: misreports single-transfer mode
1259 req->td->dmacount = 0; /* invalidate */
1260 dma_done (ep, req,
1261 readl (&ep->dma->dmacount),
1262 -ECONNRESET);
1263 }
1264 } else {
1265 DEBUG (ep->dev, "unlink (%s) pio\n", _ep->name);
1266 done (ep, req, -ECONNRESET);
1267 }
1268 req = NULL;
1269
1270 /* patch up hardware chaining data */
1271 } else if (ep->dma && use_dma_chaining) {
1272 if (req->queue.prev == ep->queue.next) {
1273 writel (le32_to_cpu (req->td->dmadesc),
1274 &ep->dma->dmadesc);
1275 if (req->td->dmacount & dma_done_ie)
1276 writel (readl (&ep->dma->dmacount)
320f3459 1277 | le32_to_cpu(dma_done_ie),
1da177e4
LT		 1278 &ep->dma->dmacount);
1279 } else {
1280 struct net2280_request *prev;
1281
1282 prev = list_entry (req->queue.prev,
1283 struct net2280_request, queue);
1284 prev->td->dmadesc = req->td->dmadesc;
1285 if (req->td->dmacount & dma_done_ie)
1286 prev->td->dmacount |= dma_done_ie;
1287 }
1288 }
1289
1290 if (req)
1291 done (ep, req, -ECONNRESET);
1292 ep->stopped = stopped;
1293
1294 if (ep->dma) {
1295 /* turn off dma on inactive queues */
1296 if (list_empty (&ep->queue))
1297 stop_dma (ep->dma);
1298 else if (!ep->stopped) {
1299 /* resume current request, or start new one */
1300 if (req)
1301 writel (dmactl, &ep->dma->dmactl);
1302 else
1303 start_dma (ep, list_entry (ep->queue.next,
1304 struct net2280_request, queue));
1305 }
1306 }
1307
1308 spin_unlock_irqrestore (&ep->dev->lock, flags);
1309 return 0;
1310}
1311
1312/*-------------------------------------------------------------------------*/
1313
1314static int net2280_fifo_status (struct usb_ep *_ep);
1315
1316static int
1317net2280_set_halt (struct usb_ep *_ep, int value)
1318{
1319 struct net2280_ep *ep;
1320 unsigned long flags;
1321 int retval = 0;
1322
1323 ep = container_of (_ep, struct net2280_ep, ep);
1324 if (!_ep || (!ep->desc && ep->num != 0))
1325 return -EINVAL;
1326 if (!ep->dev->driver || ep->dev->gadget.speed == USB_SPEED_UNKNOWN)
1327 return -ESHUTDOWN;
1328 if (ep->desc /* not ep0 */ && (ep->desc->bmAttributes & 0x03)
1329 == USB_ENDPOINT_XFER_ISOC)
1330 return -EINVAL;
1331
1332 spin_lock_irqsave (&ep->dev->lock, flags);
1333 if (!list_empty (&ep->queue))
1334 retval = -EAGAIN;
1335 else if (ep->is_in && value && net2280_fifo_status (_ep) != 0)
1336 retval = -EAGAIN;
1337 else {
1338 VDEBUG (ep->dev, "%s %s halt\n", _ep->name,
1339 value ? "set" : "clear");
1340 /* set/clear, then synch memory views with the device */
1341 if (value) {
1342 if (ep->num == 0)
1343 ep->dev->protocol_stall = 1;
1344 else
1345 set_halt (ep);
1346 } else
1347 clear_halt (ep);
1348 (void) readl (&ep->regs->ep_rsp);
1349 }
1350 spin_unlock_irqrestore (&ep->dev->lock, flags);
1351
1352 return retval;
1353}
1354
1355static int
1356net2280_fifo_status (struct usb_ep *_ep)
1357{
1358 struct net2280_ep *ep;
1359 u32 avail;
1360
1361 ep = container_of (_ep, struct net2280_ep, ep);
1362 if (!_ep || (!ep->desc && ep->num != 0))
1363 return -ENODEV;
1364 if (!ep->dev->driver || ep->dev->gadget.speed == USB_SPEED_UNKNOWN)
1365 return -ESHUTDOWN;
1366
1367 avail = readl (&ep->regs->ep_avail) & ((1 << 12) - 1);
1368 if (avail > ep->fifo_size)
1369 return -EOVERFLOW;
1370 if (ep->is_in)
1371 avail = ep->fifo_size - avail;
1372 return avail;
1373}
1374
1375static void
1376net2280_fifo_flush (struct usb_ep *_ep)
1377{
1378 struct net2280_ep *ep;
1379
1380 ep = container_of (_ep, struct net2280_ep, ep);
1381 if (!_ep || (!ep->desc && ep->num != 0))
1382 return;
1383 if (!ep->dev->driver || ep->dev->gadget.speed == USB_SPEED_UNKNOWN)
1384 return;
1385
1386 writel ((1 << FIFO_FLUSH), &ep->regs->ep_stat);
1387 (void) readl (&ep->regs->ep_rsp);
1388}
1389
901b3d75 1390static const struct usb_ep_ops net2280_ep_ops = {
1da177e4
LT		 1391 .enable = net2280_enable,
1392 .disable = net2280_disable,
1393
1394 .alloc_request = net2280_alloc_request,
1395 .free_request = net2280_free_request,
1396
1397 .alloc_buffer = net2280_alloc_buffer,
1398 .free_buffer = net2280_free_buffer,
1399
1400 .queue = net2280_queue,
1401 .dequeue = net2280_dequeue,
1402
1403 .set_halt = net2280_set_halt,
1404 .fifo_status = net2280_fifo_status,
1405 .fifo_flush = net2280_fifo_flush,
1406};
1407
1408/*-------------------------------------------------------------------------*/
1409
1410static int net2280_get_frame (struct usb_gadget *_gadget)
1411{
1412 struct net2280 *dev;
1413 unsigned long flags;
1414 u16 retval;
1415
1416 if (!_gadget)
1417 return -ENODEV;
1418 dev = container_of (_gadget, struct net2280, gadget);
1419 spin_lock_irqsave (&dev->lock, flags);
1420 retval = get_idx_reg (dev->regs, REG_FRAME) & 0x03ff;
1421 spin_unlock_irqrestore (&dev->lock, flags);
1422 return retval;
1423}
1424
1425static int net2280_wakeup (struct usb_gadget *_gadget)
1426{
1427 struct net2280 *dev;
1428 u32 tmp;
1429 unsigned long flags;
1430
1431 if (!_gadget)
1432 return 0;
1433 dev = container_of (_gadget, struct net2280, gadget);
1434
1435 spin_lock_irqsave (&dev->lock, flags);
1436 tmp = readl (&dev->usb->usbctl);
1437 if (tmp & (1 << DEVICE_REMOTE_WAKEUP_ENABLE))
1438 writel (1 << GENERATE_RESUME, &dev->usb->usbstat);
1439 spin_unlock_irqrestore (&dev->lock, flags);
1440
1441 /* pci writes may still be posted */
1442 return 0;
1443}
1444
1445static int net2280_set_selfpowered (struct usb_gadget *_gadget, int value)
1446{
1447 struct net2280 *dev;
1448 u32 tmp;
1449 unsigned long flags;
1450
1451 if (!_gadget)
1452 return 0;
1453 dev = container_of (_gadget, struct net2280, gadget);
1454
1455 spin_lock_irqsave (&dev->lock, flags);
1456 tmp = readl (&dev->usb->usbctl);
1457 if (value)
1458 tmp |= (1 << SELF_POWERED_STATUS);
1459 else
1460 tmp &= ~(1 << SELF_POWERED_STATUS);
1461 writel (tmp, &dev->usb->usbctl);
1462 spin_unlock_irqrestore (&dev->lock, flags);
1463
1464 return 0;
1465}
1466
1467static int net2280_pullup(struct usb_gadget *_gadget, int is_on)
1468{
1469 struct net2280 *dev;
1470 u32 tmp;
1471 unsigned long flags;
1472
1473 if (!_gadget)
1474 return -ENODEV;
1475 dev = container_of (_gadget, struct net2280, gadget);
1476
1477 spin_lock_irqsave (&dev->lock, flags);
1478 tmp = readl (&dev->usb->usbctl);
1479 dev->softconnect = (is_on != 0);
1480 if (is_on)
1481 tmp |= (1 << USB_DETECT_ENABLE);
1482 else
1483 tmp &= ~(1 << USB_DETECT_ENABLE);
1484 writel (tmp, &dev->usb->usbctl);
1485 spin_unlock_irqrestore (&dev->lock, flags);
1486
1487 return 0;
1488}
1489
1490static const struct usb_gadget_ops net2280_ops = {
1491 .get_frame = net2280_get_frame,
1492 .wakeup = net2280_wakeup,
1493 .set_selfpowered = net2280_set_selfpowered,
1494 .pullup = net2280_pullup,
1495};
1496
1497/*-------------------------------------------------------------------------*/
1498
1499#ifdef CONFIG_USB_GADGET_DEBUG_FILES
1500
1501/* FIXME move these into procfs, and use seq_file.
1502 * Sysfs _still_ doesn't behave for arbitrarily sized files,
1503 * and also doesn't help products using this with 2.4 kernels.
1504 */
1505
1506/* "function" sysfs attribute */
1507static ssize_t
10523b3b 1508show_function (struct device *_dev, struct device_attribute *attr, char *buf)
1da177e4
LT		 1509{
1510 struct net2280 *dev = dev_get_drvdata (_dev);
1511
1512 if (!dev->driver
1513 || !dev->driver->function
1514 || strlen (dev->driver->function) > PAGE_SIZE)
1515 return 0;
1516 return scnprintf (buf, PAGE_SIZE, "%s\n", dev->driver->function);
1517}
1518static DEVICE_ATTR (function, S_IRUGO, show_function, NULL);
1519
1520static ssize_t
10523b3b 1521show_registers (struct device *_dev, struct device_attribute *attr, char *buf)
1da177e4
LT		 1522{
1523 struct net2280 *dev;
1524 char *next;
1525 unsigned size, t;
1526 unsigned long flags;
1527 int i;
1528 u32 t1, t2;
30e69598 1529 const char *s;
1da177e4
LT		 1530
1531 dev = dev_get_drvdata (_dev);
1532 next = buf;
1533 size = PAGE_SIZE;
1534 spin_lock_irqsave (&dev->lock, flags);
1535
1536 if (dev->driver)
1537 s = dev->driver->driver.name;
1538 else
1539 s = "(none)";
1540
1541 /* Main Control Registers */
1542 t = scnprintf (next, size, "%s version " DRIVER_VERSION
1543 ", chiprev %04x, dma %s\n\n"
1544 "devinit %03x fifoctl %08x gadget '%s'\n"
1545 "pci irqenb0 %02x irqenb1 %08x "
1546 "irqstat0 %04x irqstat1 %08x\n",
1547 driver_name, dev->chiprev,
1548 use_dma
1549 ? (use_dma_chaining ? "chaining" : "enabled")
1550 : "disabled",
1551 readl (&dev->regs->devinit),
1552 readl (&dev->regs->fifoctl),
1553 s,
1554 readl (&dev->regs->pciirqenb0),
1555 readl (&dev->regs->pciirqenb1),
1556 readl (&dev->regs->irqstat0),
1557 readl (&dev->regs->irqstat1));
1558 size -= t;
1559 next += t;
1560
1561 /* USB Control Registers */
1562 t1 = readl (&dev->usb->usbctl);
1563 t2 = readl (&dev->usb->usbstat);
1564 if (t1 & (1 << VBUS_PIN)) {
1565 if (t2 & (1 << HIGH_SPEED))
1566 s = "high speed";
1567 else if (dev->gadget.speed == USB_SPEED_UNKNOWN)
1568 s = "powered";
1569 else
1570 s = "full speed";
1571 /* full speed bit (6) not working?? */
1572 } else
1573 s = "not attached";
1574 t = scnprintf (next, size,
1575 "stdrsp %08x usbctl %08x usbstat %08x "
1576 "addr 0x%02x (%s)\n",
1577 readl (&dev->usb->stdrsp), t1, t2,
1578 readl (&dev->usb->ouraddr), s);
1579 size -= t;
1580 next += t;
1581
1582 /* PCI Master Control Registers */
1583
1584 /* DMA Control Registers */
1585
1586 /* Configurable EP Control Registers */
1587 for (i = 0; i < 7; i++) {
1588 struct net2280_ep *ep;
1589
1590 ep = &dev->ep [i];
1591 if (i && !ep->desc)
1592 continue;
1593
1594 t1 = readl (&ep->regs->ep_cfg);
1595 t2 = readl (&ep->regs->ep_rsp) & 0xff;
1596 t = scnprintf (next, size,
1597 "\n%s\tcfg %05x rsp (%02x) %s%s%s%s%s%s%s%s"
1598 "irqenb %02x\n",
1599 ep->ep.name, t1, t2,
1600 (t2 & (1 << CLEAR_NAK_OUT_PACKETS))
1601 ? "NAK " : "",
1602 (t2 & (1 << CLEAR_EP_HIDE_STATUS_PHASE))
1603 ? "hide " : "",
1604 (t2 & (1 << CLEAR_EP_FORCE_CRC_ERROR))
1605 ? "CRC " : "",
1606 (t2 & (1 << CLEAR_INTERRUPT_MODE))
1607 ? "interrupt " : "",
1608 (t2 & (1<<CLEAR_CONTROL_STATUS_PHASE_HANDSHAKE))
1609 ? "status " : "",
1610 (t2 & (1 << CLEAR_NAK_OUT_PACKETS_MODE))
1611 ? "NAKmode " : "",
1612 (t2 & (1 << CLEAR_ENDPOINT_TOGGLE))
1613 ? "DATA1 " : "DATA0 ",
1614 (t2 & (1 << CLEAR_ENDPOINT_HALT))
1615 ? "HALT " : "",
1616 readl (&ep->regs->ep_irqenb));
1617 size -= t;
1618 next += t;
1619
1620 t = scnprintf (next, size,
1621 "\tstat %08x avail %04x "
1622 "(ep%d%s-%s)%s\n",
1623 readl (&ep->regs->ep_stat),
1624 readl (&ep->regs->ep_avail),
1625 t1 & 0x0f, DIR_STRING (t1),
1626 type_string (t1 >> 8),
1627 ep->stopped ? "*" : "");
1628 size -= t;
1629 next += t;
1630
1631 if (!ep->dma)
1632 continue;
1633
1634 t = scnprintf (next, size,
1635 " dma\tctl %08x stat %08x count %08x\n"
1636 "\taddr %08x desc %08x\n",
1637 readl (&ep->dma->dmactl),
1638 readl (&ep->dma->dmastat),
1639 readl (&ep->dma->dmacount),
1640 readl (&ep->dma->dmaaddr),
1641 readl (&ep->dma->dmadesc));
1642 size -= t;
1643 next += t;
1644
1645 }
1646
1647 /* Indexed Registers */
901b3d75 1648 // none yet
1da177e4
LT		 1649
1650 /* Statistics */
1651 t = scnprintf (next, size, "\nirqs: ");
1652 size -= t;
1653 next += t;
1654 for (i = 0; i < 7; i++) {
1655 struct net2280_ep *ep;
1656
1657 ep = &dev->ep [i];
1658 if (i && !ep->irqs)
1659 continue;
1660 t = scnprintf (next, size, " %s/%lu", ep->ep.name, ep->irqs);
1661 size -= t;
1662 next += t;
1663
1664 }
1665 t = scnprintf (next, size, "\n");
1666 size -= t;
1667 next += t;
1668
1669 spin_unlock_irqrestore (&dev->lock, flags);
1670
1671 return PAGE_SIZE - size;
1672}
1673static DEVICE_ATTR (registers, S_IRUGO, show_registers, NULL);
1674
1675static ssize_t
10523b3b 1676show_queues (struct device *_dev, struct device_attribute *attr, char *buf)
1da177e4
LT		 1677{
1678 struct net2280 *dev;
1679 char *next;
1680 unsigned size;
1681 unsigned long flags;
1682 int i;
1683
1684 dev = dev_get_drvdata (_dev);
1685 next = buf;
1686 size = PAGE_SIZE;
1687 spin_lock_irqsave (&dev->lock, flags);
1688
1689 for (i = 0; i < 7; i++) {
1690 struct net2280_ep *ep = &dev->ep [i];
1691 struct net2280_request *req;
1692 int t;
1693
1694 if (i != 0) {
1695 const struct usb_endpoint_descriptor *d;
1696
1697 d = ep->desc;
1698 if (!d)
1699 continue;
1700 t = d->bEndpointAddress;
1701 t = scnprintf (next, size,
1702 "\n%s (ep%d%s-%s) max %04x %s fifo %d\n",
1703 ep->ep.name, t & USB_ENDPOINT_NUMBER_MASK,
1704 (t & USB_DIR_IN) ? "in" : "out",
1705 ({ char *val;
1706 switch (d->bmAttributes & 0x03) {
1707 case USB_ENDPOINT_XFER_BULK:
901b3d75 1708 val = "bulk"; break;
1da177e4 1709 case USB_ENDPOINT_XFER_INT:
901b3d75 1710 val = "intr"; break;
1da177e4 1711 default:
901b3d75 1712 val = "iso"; break;
1da177e4
LT		 1713 }; val; }),
1714 le16_to_cpu (d->wMaxPacketSize) & 0x1fff,
1715 ep->dma ? "dma" : "pio", ep->fifo_size
1716 );
1717 } else /* ep0 should only have one transfer queued */
1718 t = scnprintf (next, size, "ep0 max 64 pio %s\n",
1719 ep->is_in ? "in" : "out");
1720 if (t <= 0 || t > size)
1721 goto done;
1722 size -= t;
1723 next += t;
1724
1725 if (list_empty (&ep->queue)) {
1726 t = scnprintf (next, size, "\t(nothing queued)\n");
1727 if (t <= 0 || t > size)
1728 goto done;
1729 size -= t;
1730 next += t;
1731 continue;
1732 }
1733 list_for_each_entry (req, &ep->queue, queue) {
1734 if (ep->dma && req->td_dma == readl (&ep->dma->dmadesc))
1735 t = scnprintf (next, size,
1736 "\treq %p len %d/%d "
1737 "buf %p (dmacount %08x)\n",
1738 &req->req, req->req.actual,
1739 req->req.length, req->req.buf,
1740 readl (&ep->dma->dmacount));
1741 else
1742 t = scnprintf (next, size,
1743 "\treq %p len %d/%d buf %p\n",
1744 &req->req, req->req.actual,
1745 req->req.length, req->req.buf);
1746 if (t <= 0 || t > size)
1747 goto done;
1748 size -= t;
1749 next += t;
1750
1751 if (ep->dma) {
1752 struct net2280_dma *td;
1753
1754 td = req->td;
1755 t = scnprintf (next, size, "\t td %08x "
1756 " count %08x buf %08x desc %08x\n",
1757 (u32) req->td_dma,
1758 le32_to_cpu (td->dmacount),
1759 le32_to_cpu (td->dmaaddr),
1760 le32_to_cpu (td->dmadesc));
1761 if (t <= 0 || t > size)
1762 goto done;
1763 size -= t;
1764 next += t;
1765 }
1766 }
1767 }
1768
1769done:
1770 spin_unlock_irqrestore (&dev->lock, flags);
1771 return PAGE_SIZE - size;
1772}
1773static DEVICE_ATTR (queues, S_IRUGO, show_queues, NULL);
1774
1775
1776#else
1777
9950421c
LT		 1778#define device_create_file(a,b) (0)
1779#define device_remove_file(a,b) do { } while (0)
1da177e4
LT		 1780
1781#endif
1782
1783/*-------------------------------------------------------------------------*/
1784
1785/* another driver-specific mode might be a request type doing dma
1786 * to/from another device fifo instead of to/from memory.
1787 */
1788
1789static void set_fifo_mode (struct net2280 *dev, int mode)
1790{
1791 /* keeping high bits preserves BAR2 */
1792 writel ((0xffff << PCI_BASE2_RANGE) | mode, &dev->regs->fifoctl);
1793
1794 /* always ep-{a,b,e,f} ... maybe not ep-c or ep-d */
1795 INIT_LIST_HEAD (&dev->gadget.ep_list);
1796 list_add_tail (&dev->ep [1].ep.ep_list, &dev->gadget.ep_list);
1797 list_add_tail (&dev->ep [2].ep.ep_list, &dev->gadget.ep_list);
1798 switch (mode) {
1799 case 0:
1800 list_add_tail (&dev->ep [3].ep.ep_list, &dev->gadget.ep_list);
1801 list_add_tail (&dev->ep [4].ep.ep_list, &dev->gadget.ep_list);
1802 dev->ep [1].fifo_size = dev->ep [2].fifo_size = 1024;
1803 break;
1804 case 1:
1805 dev->ep [1].fifo_size = dev->ep [2].fifo_size = 2048;
1806 break;
1807 case 2:
1808 list_add_tail (&dev->ep [3].ep.ep_list, &dev->gadget.ep_list);
1809 dev->ep [1].fifo_size = 2048;
1810 dev->ep [2].fifo_size = 1024;
1811 break;
1812 }
1813 /* fifo sizes for ep0, ep-c, ep-d, ep-e, and ep-f never change */
1814 list_add_tail (&dev->ep [5].ep.ep_list, &dev->gadget.ep_list);
1815 list_add_tail (&dev->ep [6].ep.ep_list, &dev->gadget.ep_list);
1816}
1817
320f3459
DB		 1818/* just declare this in any driver that really need it */
1819extern int net2280_set_fifo_mode (struct usb_gadget *gadget, int mode);
1820
1da177e4
LT		 1821/**
1822 * net2280_set_fifo_mode - change allocation of fifo buffers
1823 * @gadget: access to the net2280 device that will be updated
1824 * @mode: 0 for default, four 1kB buffers (ep-a through ep-d);
901b3d75
DB		 1825 * 1 for two 2kB buffers (ep-a and ep-b only);
1826 * 2 for one 2kB buffer (ep-a) and two 1kB ones (ep-b, ep-c).
1da177e4
LT		 1827 *
1828 * returns zero on success, else negative errno. when this succeeds,
1829 * the contents of gadget->ep_list may have changed.
1830 *
1831 * you may only call this function when endpoints a-d are all disabled.
1832 * use it whenever extra hardware buffering can help performance, such
1833 * as before enabling "high bandwidth" interrupt endpoints that use
1834 * maxpacket bigger than 512 (when double buffering would otherwise
1835 * be unavailable).
1836 */
1837int net2280_set_fifo_mode (struct usb_gadget *gadget, int mode)
1838{
1839 int i;
1840 struct net2280 *dev;
1841 int status = 0;
1842 unsigned long flags;
1843
1844 if (!gadget)
1845 return -ENODEV;
1846 dev = container_of (gadget, struct net2280, gadget);
1847
1848 spin_lock_irqsave (&dev->lock, flags);
1849
1850 for (i = 1; i <= 4; i++)
1851 if (dev->ep [i].desc) {
1852 status = -EINVAL;
1853 break;
1854 }
1855 if (mode < 0 || mode > 2)
1856 status = -EINVAL;
1857 if (status == 0)
1858 set_fifo_mode (dev, mode);
1859 spin_unlock_irqrestore (&dev->lock, flags);
1860
1861 if (status == 0) {
1862 if (mode == 1)
1863 DEBUG (dev, "fifo: ep-a 2K, ep-b 2K\n");
1864 else if (mode == 2)
1865 DEBUG (dev, "fifo: ep-a 2K, ep-b 1K, ep-c 1K\n");
1866 /* else all are 1K */
1867 }
1868 return status;
1869}
1870EXPORT_SYMBOL (net2280_set_fifo_mode);
1871
1872/*-------------------------------------------------------------------------*/
1873
1874/* keeping it simple:
1875 * - one bus driver, initted first;
1876 * - one function driver, initted second
1877 *
1878 * most of the work to support multiple net2280 controllers would
1879 * be to associate this gadget driver (yes?) with all of them, or
1880 * perhaps to bind specific drivers to specific devices.
1881 */
1882
1883static struct net2280 *the_controller;
1884
1885static void usb_reset (struct net2280 *dev)
1886{
1887 u32 tmp;
1888
1889 dev->gadget.speed = USB_SPEED_UNKNOWN;
1890 (void) readl (&dev->usb->usbctl);
1891
1892 net2280_led_init (dev);
1893
1894 /* disable automatic responses, and irqs */
1895 writel (0, &dev->usb->stdrsp);
1896 writel (0, &dev->regs->pciirqenb0);
1897 writel (0, &dev->regs->pciirqenb1);
1898
1899 /* clear old dma and irq state */
1900 for (tmp = 0; tmp < 4; tmp++) {
1901 struct net2280_ep *ep = &dev->ep [tmp + 1];
1902
1903 if (ep->dma)
1904 abort_dma (ep);
1905 }
1906 writel (~0, &dev->regs->irqstat0),
1907 writel (~(1 << SUSPEND_REQUEST_INTERRUPT), &dev->regs->irqstat1),
1908
1909 /* reset, and enable pci */
1910 tmp = readl (&dev->regs->devinit)
1911 | (1 << PCI_ENABLE)
1912 | (1 << FIFO_SOFT_RESET)
1913 | (1 << USB_SOFT_RESET)
1914 | (1 << M8051_RESET);
1915 writel (tmp, &dev->regs->devinit);
1916
1917 /* standard fifo and endpoint allocations */
1918 set_fifo_mode (dev, (fifo_mode <= 2) ? fifo_mode : 0);
1919}
1920
1921static void usb_reinit (struct net2280 *dev)
1922{
1923 u32 tmp;
1924 int init_dma;
1925
1926 /* use_dma changes are ignored till next device re-init */
1927 init_dma = use_dma;
1928
1929 /* basic endpoint init */
1930 for (tmp = 0; tmp < 7; tmp++) {
1931 struct net2280_ep *ep = &dev->ep [tmp];
1932
1933 ep->ep.name = ep_name [tmp];
1934 ep->dev = dev;
1935 ep->num = tmp;
1936
1937 if (tmp > 0 && tmp <= 4) {
1938 ep->fifo_size = 1024;
1939 if (init_dma)
1940 ep->dma = &dev->dma [tmp - 1];
1941 } else
1942 ep->fifo_size = 64;
1943 ep->regs = &dev->epregs [tmp];
1944 ep_reset (dev->regs, ep);
1945 }
1946 dev->ep [0].ep.maxpacket = 64;
1947 dev->ep [5].ep.maxpacket = 64;
1948 dev->ep [6].ep.maxpacket = 64;
1949
1950 dev->gadget.ep0 = &dev->ep [0].ep;
1951 dev->ep [0].stopped = 0;
1952 INIT_LIST_HEAD (&dev->gadget.ep0->ep_list);
1953
1954 /* we want to prevent lowlevel/insecure access from the USB host,
1955 * but erratum 0119 means this enable bit is ignored
1956 */
1957 for (tmp = 0; tmp < 5; tmp++)
1958 writel (EP_DONTUSE, &dev->dep [tmp].dep_cfg);
1959}
1960
1961static void ep0_start (struct net2280 *dev)
1962{
1963 writel ( (1 << CLEAR_EP_HIDE_STATUS_PHASE)
1964 | (1 << CLEAR_NAK_OUT_PACKETS)
1965 | (1 << CLEAR_CONTROL_STATUS_PHASE_HANDSHAKE)
1966 , &dev->epregs [0].ep_rsp);
1967
1968 /*
1969 * hardware optionally handles a bunch of standard requests
1970 * that the API hides from drivers anyway. have it do so.
1971 * endpoint status/features are handled in software, to
1972 * help pass tests for some dubious behavior.
1973 */
1974 writel ( (1 << SET_TEST_MODE)
1975 | (1 << SET_ADDRESS)
1976 | (1 << DEVICE_SET_CLEAR_DEVICE_REMOTE_WAKEUP)
1977 | (1 << GET_DEVICE_STATUS)
1978 | (1 << GET_INTERFACE_STATUS)
1979 , &dev->usb->stdrsp);
1980 writel ( (1 << USB_ROOT_PORT_WAKEUP_ENABLE)
1981 | (1 << SELF_POWERED_USB_DEVICE)
1982 | (1 << REMOTE_WAKEUP_SUPPORT)
1983 | (dev->softconnect << USB_DETECT_ENABLE)
1984 | (1 << SELF_POWERED_STATUS)
1985 , &dev->usb->usbctl);
1986
1987 /* enable irqs so we can see ep0 and general operation */
1988 writel ( (1 << SETUP_PACKET_INTERRUPT_ENABLE)
1989 | (1 << ENDPOINT_0_INTERRUPT_ENABLE)
1990 , &dev->regs->pciirqenb0);
1991 writel ( (1 << PCI_INTERRUPT_ENABLE)
1992 | (1 << PCI_MASTER_ABORT_RECEIVED_INTERRUPT_ENABLE)
1993 | (1 << PCI_TARGET_ABORT_RECEIVED_INTERRUPT_ENABLE)
1994 | (1 << PCI_RETRY_ABORT_INTERRUPT_ENABLE)
1995 | (1 << VBUS_INTERRUPT_ENABLE)
1996 | (1 << ROOT_PORT_RESET_INTERRUPT_ENABLE)
1997 | (1 << SUSPEND_REQUEST_CHANGE_INTERRUPT_ENABLE)
1998 , &dev->regs->pciirqenb1);
1999
2000 /* don't leave any writes posted */
2001 (void) readl (&dev->usb->usbctl);
2002}
2003
2004/* when a driver is successfully registered, it will receive
2005 * control requests including set_configuration(), which enables
2006 * non-control requests. then usb traffic follows until a
2007 * disconnect is reported. then a host may connect again, or
2008 * the driver might get unbound.
2009 */
2010int usb_gadget_register_driver (struct usb_gadget_driver *driver)
2011{
2012 struct net2280 *dev = the_controller;
2013 int retval;
2014 unsigned i;
2015
2016 /* insist on high speed support from the driver, since
2017 * (dev->usb->xcvrdiag & FORCE_FULL_SPEED_MODE)
2018 * "must not be used in normal operation"
2019 */
2020 if (!driver
2021 || driver->speed != USB_SPEED_HIGH
2022 || !driver->bind
1da177e4
LT		 2023 || !driver->setup)
2024 return -EINVAL;
2025 if (!dev)
2026 return -ENODEV;
2027 if (dev->driver)
2028 return -EBUSY;
2029
2030 for (i = 0; i < 7; i++)
2031 dev->ep [i].irqs = 0;
2032
2033 /* hook up the driver ... */
2034 dev->softconnect = 1;
2035 driver->driver.bus = NULL;
2036 dev->driver = driver;
2037 dev->gadget.dev.driver = &driver->driver;
2038 retval = driver->bind (&dev->gadget);
2039 if (retval) {
2040 DEBUG (dev, "bind to driver %s --> %d\n",
2041 driver->driver.name, retval);
2042 dev->driver = NULL;
2043 dev->gadget.dev.driver = NULL;
2044 return retval;
2045 }
2046
b3899dac
JG		 2047 retval = device_create_file (&dev->pdev->dev, &dev_attr_function);
2048 if (retval) goto err_unbind;
2049 retval = device_create_file (&dev->pdev->dev, &dev_attr_queues);
2050 if (retval) goto err_func;
1da177e4
LT		 2051
2052 /* ... then enable host detection and ep0; and we're ready
2053 * for set_configuration as well as eventual disconnect.
2054 */
2055 net2280_led_active (dev, 1);
2056 ep0_start (dev);
2057
2058 DEBUG (dev, "%s ready, usbctl %08x stdrsp %08x\n",
2059 driver->driver.name,
2060 readl (&dev->usb->usbctl),
2061 readl (&dev->usb->stdrsp));
2062
2063 /* pci writes may still be posted */
2064 return 0;
b3899dac
JG		 2065
2066err_func:
2067 device_remove_file (&dev->pdev->dev, &dev_attr_function);
2068err_unbind:
2069 driver->unbind (&dev->gadget);
2070 dev->gadget.dev.driver = NULL;
2071 dev->driver = NULL;
2072 return retval;
1da177e4
LT		 2073}
2074EXPORT_SYMBOL (usb_gadget_register_driver);
2075
2076static void
2077stop_activity (struct net2280 *dev, struct usb_gadget_driver *driver)
2078{
2079 int i;
2080
2081 /* don't disconnect if it's not connected */
2082 if (dev->gadget.speed == USB_SPEED_UNKNOWN)
2083 driver = NULL;
2084
2085 /* stop hardware; prevent new request submissions;
2086 * and kill any outstanding requests.
2087 */
2088 usb_reset (dev);
2089 for (i = 0; i < 7; i++)
2090 nuke (&dev->ep [i]);
2091
2092 /* report disconnect; the driver is already quiesced */
2093 if (driver) {
2094 spin_unlock (&dev->lock);
2095 driver->disconnect (&dev->gadget);
2096 spin_lock (&dev->lock);
2097 }
2098
2099 usb_reinit (dev);
2100}
2101
2102int usb_gadget_unregister_driver (struct usb_gadget_driver *driver)
2103{
2104 struct net2280 *dev = the_controller;
2105 unsigned long flags;
2106
2107 if (!dev)
2108 return -ENODEV;
6bea476c 2109 if (!driver || driver != dev->driver || !driver->unbind)
1da177e4
LT		 2110 return -EINVAL;
2111
2112 spin_lock_irqsave (&dev->lock, flags);
2113 stop_activity (dev, driver);
2114 spin_unlock_irqrestore (&dev->lock, flags);
2115
2116 net2280_pullup (&dev->gadget, 0);
2117
2118 driver->unbind (&dev->gadget);
2119 dev->gadget.dev.driver = NULL;
2120 dev->driver = NULL;
2121
2122 net2280_led_active (dev, 0);
2123 device_remove_file (&dev->pdev->dev, &dev_attr_function);
2124 device_remove_file (&dev->pdev->dev, &dev_attr_queues);
2125
2126 DEBUG (dev, "unregistered driver '%s'\n", driver->driver.name);
2127 return 0;
2128}
2129EXPORT_SYMBOL (usb_gadget_unregister_driver);
2130
2131
2132/*-------------------------------------------------------------------------*/
2133
2134/* handle ep0, ep-e, ep-f with 64 byte packets: packet per irq.
2135 * also works for dma-capable endpoints, in pio mode or just
2136 * to manually advance the queue after short OUT transfers.
2137 */
2138static void handle_ep_small (struct net2280_ep *ep)
2139{
2140 struct net2280_request *req;
2141 u32 t;
2142 /* 0 error, 1 mid-data, 2 done */
2143 int mode = 1;
2144
2145 if (!list_empty (&ep->queue))
2146 req = list_entry (ep->queue.next,
2147 struct net2280_request, queue);
2148 else
2149 req = NULL;
2150
2151 /* ack all, and handle what we care about */
2152 t = readl (&ep->regs->ep_stat);
2153 ep->irqs++;
2154#if 0
2155 VDEBUG (ep->dev, "%s ack ep_stat %08x, req %p\n",
2156 ep->ep.name, t, req ? &req->req : 0);
2157#endif
950ee4c8
GL		 2158 if (!ep->is_in || ep->dev->pdev->device == 0x2280)
2159 writel (t & ~(1 << NAK_OUT_PACKETS), &ep->regs->ep_stat);
2160 else
2161 /* Added for 2282 */
2162 writel (t, &ep->regs->ep_stat);
1da177e4
LT		 2163
2164 /* for ep0, monitor token irqs to catch data stage length errors
2165 * and to synchronize on status.
2166 *
2167 * also, to defer reporting of protocol stalls ... here's where
2168 * data or status first appears, handling stalls here should never
2169 * cause trouble on the host side..
2170 *
2171 * control requests could be slightly faster without token synch for
2172 * status, but status can jam up that way.
2173 */
2174 if (unlikely (ep->num == 0)) {
2175 if (ep->is_in) {
2176 /* status; stop NAKing */
2177 if (t & (1 << DATA_OUT_PING_TOKEN_INTERRUPT)) {
2178 if (ep->dev->protocol_stall) {
2179 ep->stopped = 1;
2180 set_halt (ep);
2181 }
2182 if (!req)
2183 allow_status (ep);
2184 mode = 2;
2185 /* reply to extra IN data tokens with a zlp */
2186 } else if (t & (1 << DATA_IN_TOKEN_INTERRUPT)) {
2187 if (ep->dev->protocol_stall) {
2188 ep->stopped = 1;
2189 set_halt (ep);
2190 mode = 2;
1f26e28d
AS		 2191 } else if (ep->responded &&
2192 !req && !ep->stopped)
1da177e4
LT		 2193 write_fifo (ep, NULL);
2194 }
2195 } else {
2196 /* status; stop NAKing */
2197 if (t & (1 << DATA_IN_TOKEN_INTERRUPT)) {
2198 if (ep->dev->protocol_stall) {
2199 ep->stopped = 1;
2200 set_halt (ep);
2201 }
2202 mode = 2;
2203 /* an extra OUT token is an error */
2204 } else if (((t & (1 << DATA_OUT_PING_TOKEN_INTERRUPT))
2205 && req
2206 && req->req.actual == req->req.length)
1f26e28d 2207 || (ep->responded && !req)) {
1da177e4
LT		 2208 ep->dev->protocol_stall = 1;
2209 set_halt (ep);
2210 ep->stopped = 1;
2211 if (req)
2212 done (ep, req, -EOVERFLOW);
2213 req = NULL;
2214 }
2215 }
2216 }
2217
2218 if (unlikely (!req))
2219 return;
2220
2221 /* manual DMA queue advance after short OUT */
2222 if (likely (ep->dma != 0)) {
2223 if (t & (1 << SHORT_PACKET_TRANSFERRED_INTERRUPT)) {
2224 u32 count;
2225 int stopped = ep->stopped;
2226
2227 /* TRANSFERRED works around OUT_DONE erratum 0112.
2228 * we expect (N <= maxpacket) bytes; host wrote M.
2229 * iff (M < N) we won't ever see a DMA interrupt.
2230 */
2231 ep->stopped = 1;
2232 for (count = 0; ; t = readl (&ep->regs->ep_stat)) {
2233
2234 /* any preceding dma transfers must finish.
2235 * dma handles (M >= N), may empty the queue
2236 */
2237 scan_dma_completions (ep);
2238 if (unlikely (list_empty (&ep->queue)
2239 || ep->out_overflow)) {
2240 req = NULL;
2241 break;
2242 }
2243 req = list_entry (ep->queue.next,
2244 struct net2280_request, queue);
2245
2246 /* here either (M < N), a "real" short rx;
2247 * or (M == N) and the queue didn't empty
2248 */
2249 if (likely (t & (1 << FIFO_EMPTY))) {
2250 count = readl (&ep->dma->dmacount);
2251 count &= DMA_BYTE_COUNT_MASK;
2252 if (readl (&ep->dma->dmadesc)
2253 != req->td_dma)
2254 req = NULL;
2255 break;
2256 }
2257 udelay(1);
2258 }
2259
2260 /* stop DMA, leave ep NAKing */
2261 writel ((1 << DMA_ABORT), &ep->dma->dmastat);
2262 spin_stop_dma (ep->dma);
2263
2264 if (likely (req)) {
2265 req->td->dmacount = 0;
2266 t = readl (&ep->regs->ep_avail);
68dcc688 2267 dma_done (ep, req, count,
901b3d75
DB		 2268 (ep->out_overflow || t)
2269 ? -EOVERFLOW : 0);
1da177e4
LT		 2270 }
2271
2272 /* also flush to prevent erratum 0106 trouble */
2273 if (unlikely (ep->out_overflow
2274 || (ep->dev->chiprev == 0x0100
2275 && ep->dev->gadget.speed
2276 == USB_SPEED_FULL))) {
2277 out_flush (ep);
2278 ep->out_overflow = 0;
2279 }
2280
2281 /* (re)start dma if needed, stop NAKing */
2282 ep->stopped = stopped;
2283 if (!list_empty (&ep->queue))
2284 restart_dma (ep);
2285 } else
2286 DEBUG (ep->dev, "%s dma ep_stat %08x ??\n",
2287 ep->ep.name, t);
2288 return;
2289
2290 /* data packet(s) received (in the fifo, OUT) */
2291 } else if (t & (1 << DATA_PACKET_RECEIVED_INTERRUPT)) {
2292 if (read_fifo (ep, req) && ep->num != 0)
2293 mode = 2;
2294
2295 /* data packet(s) transmitted (IN) */
2296 } else if (t & (1 << DATA_PACKET_TRANSMITTED_INTERRUPT)) {
2297 unsigned len;
2298
2299 len = req->req.length - req->req.actual;
2300 if (len > ep->ep.maxpacket)
2301 len = ep->ep.maxpacket;
2302 req->req.actual += len;
2303
2304 /* if we wrote it all, we're usually done */
2305 if (req->req.actual == req->req.length) {
2306 if (ep->num == 0) {
317e83b8 2307 /* send zlps until the status stage */
1da177e4
LT		 2308 } else if (!req->req.zero || len != ep->ep.maxpacket)
2309 mode = 2;
2310 }
2311
2312 /* there was nothing to do ... */
2313 } else if (mode == 1)
2314 return;
2315
2316 /* done */
2317 if (mode == 2) {
2318 /* stream endpoints often resubmit/unlink in completion */
2319 done (ep, req, 0);
2320
2321 /* maybe advance queue to next request */
2322 if (ep->num == 0) {
2323 /* NOTE: net2280 could let gadget driver start the
2324 * status stage later. since not all controllers let
2325 * them control that, the api doesn't (yet) allow it.
2326 */
2327 if (!ep->stopped)
2328 allow_status (ep);
2329 req = NULL;
2330 } else {
2331 if (!list_empty (&ep->queue) && !ep->stopped)
2332 req = list_entry (ep->queue.next,
2333 struct net2280_request, queue);
2334 else
2335 req = NULL;
2336 if (req && !ep->is_in)
2337 stop_out_naking (ep);
2338 }
2339 }
2340
2341 /* is there a buffer for the next packet?
2342 * for best streaming performance, make sure there is one.
2343 */
2344 if (req && !ep->stopped) {
2345
2346 /* load IN fifo with next packet (may be zlp) */
2347 if (t & (1 << DATA_PACKET_TRANSMITTED_INTERRUPT))
2348 write_fifo (ep, &req->req);
2349 }
2350}
2351
2352static struct net2280_ep *
2353get_ep_by_addr (struct net2280 *dev, u16 wIndex)
2354{
2355 struct net2280_ep *ep;
2356
2357 if ((wIndex & USB_ENDPOINT_NUMBER_MASK) == 0)
2358 return &dev->ep [0];
2359 list_for_each_entry (ep, &dev->gadget.ep_list, ep.ep_list) {
2360 u8 bEndpointAddress;
2361
2362 if (!ep->desc)
2363 continue;
2364 bEndpointAddress = ep->desc->bEndpointAddress;
2365 if ((wIndex ^ bEndpointAddress) & USB_DIR_IN)
2366 continue;
2367 if ((wIndex & 0x0f) == (bEndpointAddress & 0x0f))
2368 return ep;
2369 }
2370 return NULL;
2371}
2372
2373static void handle_stat0_irqs (struct net2280 *dev, u32 stat)
2374{
2375 struct net2280_ep *ep;
2376 u32 num, scratch;
2377
2378 /* most of these don't need individual acks */
2379 stat &= ~(1 << INTA_ASSERTED);
2380 if (!stat)
2381 return;
2382 // DEBUG (dev, "irqstat0 %04x\n", stat);
2383
2384 /* starting a control request? */
2385 if (unlikely (stat & (1 << SETUP_PACKET_INTERRUPT))) {
2386 union {
2387 u32 raw [2];
2388 struct usb_ctrlrequest r;
2389 } u;
950ee4c8 2390 int tmp;
1da177e4
LT		 2391 struct net2280_request *req;
2392
2393 if (dev->gadget.speed == USB_SPEED_UNKNOWN) {
2394 if (readl (&dev->usb->usbstat) & (1 << HIGH_SPEED))
2395 dev->gadget.speed = USB_SPEED_HIGH;
2396 else
2397 dev->gadget.speed = USB_SPEED_FULL;
2398 net2280_led_speed (dev, dev->gadget.speed);
2399 DEBUG (dev, "%s speed\n",
2400 (dev->gadget.speed == USB_SPEED_HIGH)
2401 ? "high" : "full");
2402 }
2403
2404 ep = &dev->ep [0];
2405 ep->irqs++;
2406
2407 /* make sure any leftover request state is cleared */
2408 stat &= ~(1 << ENDPOINT_0_INTERRUPT);
2409 while (!list_empty (&ep->queue)) {
2410 req = list_entry (ep->queue.next,
2411 struct net2280_request, queue);
2412 done (ep, req, (req->req.actual == req->req.length)
2413 ? 0 : -EPROTO);
2414 }
2415 ep->stopped = 0;
2416 dev->protocol_stall = 0;
950ee4c8
GL		 2417
2418 if (ep->dev->pdev->device == 0x2280)
2419 tmp = (1 << FIFO_OVERFLOW)
2420 | (1 << FIFO_UNDERFLOW);
2421 else
2422 tmp = 0;
2423
2424 writel (tmp | (1 << TIMEOUT)
1da177e4
LT		 2425 | (1 << USB_STALL_SENT)
2426 | (1 << USB_IN_NAK_SENT)
2427 | (1 << USB_IN_ACK_RCVD)
2428 | (1 << USB_OUT_PING_NAK_SENT)
2429 | (1 << USB_OUT_ACK_SENT)
1da177e4
LT		 2430 | (1 << SHORT_PACKET_OUT_DONE_INTERRUPT)
2431 | (1 << SHORT_PACKET_TRANSFERRED_INTERRUPT)
2432 | (1 << DATA_PACKET_RECEIVED_INTERRUPT)
2433 | (1 << DATA_PACKET_TRANSMITTED_INTERRUPT)
2434 | (1 << DATA_OUT_PING_TOKEN_INTERRUPT)
2435 | (1 << DATA_IN_TOKEN_INTERRUPT)
2436 , &ep->regs->ep_stat);
2437 u.raw [0] = readl (&dev->usb->setup0123);
2438 u.raw [1] = readl (&dev->usb->setup4567);
901b3d75 2439
1da177e4
LT		 2440 cpu_to_le32s (&u.raw [0]);
2441 cpu_to_le32s (&u.raw [1]);
2442
950ee4c8
GL		 2443 tmp = 0;
2444
320f3459
DB		 2445#define w_value le16_to_cpup (&u.r.wValue)
2446#define w_index le16_to_cpup (&u.r.wIndex)
2447#define w_length le16_to_cpup (&u.r.wLength)
1da177e4
LT		 2448
2449 /* ack the irq */
2450 writel (1 << SETUP_PACKET_INTERRUPT, &dev->regs->irqstat0);
2451 stat ^= (1 << SETUP_PACKET_INTERRUPT);
2452
2453 /* watch control traffic at the token level, and force
2454 * synchronization before letting the status stage happen.
2455 * FIXME ignore tokens we'll NAK, until driver responds.
2456 * that'll mean a lot less irqs for some drivers.
2457 */
2458 ep->is_in = (u.r.bRequestType & USB_DIR_IN) != 0;
2459 if (ep->is_in) {
2460 scratch = (1 << DATA_PACKET_TRANSMITTED_INTERRUPT)
2461 | (1 << DATA_OUT_PING_TOKEN_INTERRUPT)
2462 | (1 << DATA_IN_TOKEN_INTERRUPT);
2463 stop_out_naking (ep);
2464 } else
2465 scratch = (1 << DATA_PACKET_RECEIVED_INTERRUPT)
2466 | (1 << DATA_OUT_PING_TOKEN_INTERRUPT)
2467 | (1 << DATA_IN_TOKEN_INTERRUPT);
2468 writel (scratch, &dev->epregs [0].ep_irqenb);
2469
2470 /* we made the hardware handle most lowlevel requests;
2471 * everything else goes uplevel to the gadget code.
2472 */
1f26e28d 2473 ep->responded = 1;
1da177e4
LT		 2474 switch (u.r.bRequest) {
2475 case USB_REQ_GET_STATUS: {
2476 struct net2280_ep *e;
320f3459 2477 __le32 status;
1da177e4
LT		 2478
2479 /* hw handles device and interface status */
2480 if (u.r.bRequestType != (USB_DIR_IN|USB_RECIP_ENDPOINT))
2481 goto delegate;
320f3459
DB		 2482 if ((e = get_ep_by_addr (dev, w_index)) == 0
2483 || w_length > 2)
1da177e4
LT		 2484 goto do_stall;
2485
2486 if (readl (&e->regs->ep_rsp)
2487 & (1 << SET_ENDPOINT_HALT))
320f3459 2488 status = __constant_cpu_to_le32 (1);
1da177e4 2489 else
320f3459 2490 status = __constant_cpu_to_le32 (0);
1da177e4
LT		 2491
2492 /* don't bother with a request object! */
2493 writel (0, &dev->epregs [0].ep_irqenb);
320f3459
DB		 2494 set_fifo_bytecount (ep, w_length);
2495 writel ((__force u32)status, &dev->epregs [0].ep_data);
1da177e4
LT		 2496 allow_status (ep);
2497 VDEBUG (dev, "%s stat %02x\n", ep->ep.name, status);
2498 goto next_endpoints;
2499 }
2500 break;
2501 case USB_REQ_CLEAR_FEATURE: {
2502 struct net2280_ep *e;
2503
2504 /* hw handles device features */
2505 if (u.r.bRequestType != USB_RECIP_ENDPOINT)
2506 goto delegate;
320f3459
DB		 2507 if (w_value != USB_ENDPOINT_HALT
2508 || w_length != 0)
1da177e4 2509 goto do_stall;
320f3459 2510 if ((e = get_ep_by_addr (dev, w_index)) == 0)
1da177e4
LT		 2511 goto do_stall;
2512 clear_halt (e);
2513 allow_status (ep);
2514 VDEBUG (dev, "%s clear halt\n", ep->ep.name);
2515 goto next_endpoints;
2516 }
2517 break;
2518 case USB_REQ_SET_FEATURE: {
2519 struct net2280_ep *e;
2520
2521 /* hw handles device features */
2522 if (u.r.bRequestType != USB_RECIP_ENDPOINT)
2523 goto delegate;
320f3459
DB		 2524 if (w_value != USB_ENDPOINT_HALT
2525 || w_length != 0)
1da177e4 2526 goto do_stall;
320f3459 2527 if ((e = get_ep_by_addr (dev, w_index)) == 0)
1da177e4
LT		 2528 goto do_stall;
2529 set_halt (e);
2530 allow_status (ep);
2531 VDEBUG (dev, "%s set halt\n", ep->ep.name);
2532 goto next_endpoints;
2533 }
2534 break;
2535 default:
2536delegate:
320f3459 2537 VDEBUG (dev, "setup %02x.%02x v%04x i%04x l%04x"
1da177e4
LT		 2538 "ep_cfg %08x\n",
2539 u.r.bRequestType, u.r.bRequest,
320f3459 2540 w_value, w_index, w_length,
1da177e4 2541 readl (&ep->regs->ep_cfg));
1f26e28d 2542 ep->responded = 0;
1da177e4
LT		 2543 spin_unlock (&dev->lock);
2544 tmp = dev->driver->setup (&dev->gadget, &u.r);
2545 spin_lock (&dev->lock);
2546 }
2547
2548 /* stall ep0 on error */
2549 if (tmp < 0) {
2550do_stall:
2551 VDEBUG (dev, "req %02x.%02x protocol STALL; stat %d\n",
2552 u.r.bRequestType, u.r.bRequest, tmp);
2553 dev->protocol_stall = 1;
2554 }
2555
2556 /* some in/out token irq should follow; maybe stall then.
2557 * driver must queue a request (even zlp) or halt ep0
2558 * before the host times out.
2559 */
2560 }
2561
320f3459
DB		 2562#undef w_value
2563#undef w_index
2564#undef w_length
2565
1da177e4
LT		 2566next_endpoints:
2567 /* endpoint data irq ? */
2568 scratch = stat & 0x7f;
2569 stat &= ~0x7f;
2570 for (num = 0; scratch; num++) {
2571 u32 t;
2572
2573 /* do this endpoint's FIFO and queue need tending? */
2574 t = 1 << num;
2575 if ((scratch & t) == 0)
2576 continue;
2577 scratch ^= t;
2578
2579 ep = &dev->ep [num];
2580 handle_ep_small (ep);
2581 }
2582
2583 if (stat)
2584 DEBUG (dev, "unhandled irqstat0 %08x\n", stat);
2585}
2586
2587#define DMA_INTERRUPTS ( \
2588 (1 << DMA_D_INTERRUPT) \
2589 | (1 << DMA_C_INTERRUPT) \
2590 | (1 << DMA_B_INTERRUPT) \
2591 | (1 << DMA_A_INTERRUPT))
2592#define PCI_ERROR_INTERRUPTS ( \
2593 (1 << PCI_MASTER_ABORT_RECEIVED_INTERRUPT) \
2594 | (1 << PCI_TARGET_ABORT_RECEIVED_INTERRUPT) \
2595 | (1 << PCI_RETRY_ABORT_INTERRUPT))
2596
2597static void handle_stat1_irqs (struct net2280 *dev, u32 stat)
2598{
2599 struct net2280_ep *ep;
2600 u32 tmp, num, mask, scratch;
2601
2602 /* after disconnect there's nothing else to do! */
2603 tmp = (1 << VBUS_INTERRUPT) | (1 << ROOT_PORT_RESET_INTERRUPT);
2604 mask = (1 << HIGH_SPEED) | (1 << FULL_SPEED);
2605
2606 /* VBUS disconnect is indicated by VBUS_PIN and VBUS_INTERRUPT set.
2607 * Root Port Reset is indicated by ROOT_PORT_RESET_INTERRRUPT set and
901b3d75 2608 * both HIGH_SPEED and FULL_SPEED clear (as ROOT_PORT_RESET_INTERRUPT
1da177e4
LT		 2609 * only indicates a change in the reset state).
2610 */
2611 if (stat & tmp) {
2612 writel (tmp, &dev->regs->irqstat1);
901b3d75
DB		 2613 if ((((stat & (1 << ROOT_PORT_RESET_INTERRUPT))
2614 && ((readl (&dev->usb->usbstat) & mask)
2615 == 0))
2616 || ((readl (&dev->usb->usbctl)
2617 & (1 << VBUS_PIN)) == 0)
1da177e4
LT		 2618 ) && ( dev->gadget.speed != USB_SPEED_UNKNOWN)) {
2619 DEBUG (dev, "disconnect %s\n",
2620 dev->driver->driver.name);
2621 stop_activity (dev, dev->driver);
2622 ep0_start (dev);
2623 return;
2624 }
2625 stat &= ~tmp;
2626
2627 /* vBUS can bounce ... one of many reasons to ignore the
2628 * notion of hotplug events on bus connect/disconnect!
2629 */
2630 if (!stat)
2631 return;
2632 }
2633
2634 /* NOTE: chip stays in PCI D0 state for now, but it could
2635 * enter D1 to save more power
2636 */
2637 tmp = (1 << SUSPEND_REQUEST_CHANGE_INTERRUPT);
2638 if (stat & tmp) {
2639 writel (tmp, &dev->regs->irqstat1);
2640 if (stat & (1 << SUSPEND_REQUEST_INTERRUPT)) {
2641 if (dev->driver->suspend)
2642 dev->driver->suspend (&dev->gadget);
2643 if (!enable_suspend)
2644 stat &= ~(1 << SUSPEND_REQUEST_INTERRUPT);
2645 } else {
2646 if (dev->driver->resume)
2647 dev->driver->resume (&dev->gadget);
2648 /* at high speed, note erratum 0133 */
2649 }
2650 stat &= ~tmp;
2651 }
2652
2653 /* clear any other status/irqs */
2654 if (stat)
2655 writel (stat, &dev->regs->irqstat1);
2656
2657 /* some status we can just ignore */
950ee4c8
GL		 2658 if (dev->pdev->device == 0x2280)
2659 stat &= ~((1 << CONTROL_STATUS_INTERRUPT)
2660 | (1 << SUSPEND_REQUEST_INTERRUPT)
2661 | (1 << RESUME_INTERRUPT)
2662 | (1 << SOF_INTERRUPT));
2663 else
2664 stat &= ~((1 << CONTROL_STATUS_INTERRUPT)
2665 | (1 << RESUME_INTERRUPT)
2666 | (1 << SOF_DOWN_INTERRUPT)
2667 | (1 << SOF_INTERRUPT));
2668
1da177e4
LT		 2669 if (!stat)
2670 return;
2671 // DEBUG (dev, "irqstat1 %08x\n", stat);
2672
2673 /* DMA status, for ep-{a,b,c,d} */
2674 scratch = stat & DMA_INTERRUPTS;
2675 stat &= ~DMA_INTERRUPTS;
2676 scratch >>= 9;
2677 for (num = 0; scratch; num++) {
2678 struct net2280_dma_regs __iomem *dma;
2679
2680 tmp = 1 << num;
2681 if ((tmp & scratch) == 0)
2682 continue;
2683 scratch ^= tmp;
2684
2685 ep = &dev->ep [num + 1];
2686 dma = ep->dma;
2687
2688 if (!dma)
2689 continue;
2690
2691 /* clear ep's dma status */
2692 tmp = readl (&dma->dmastat);
2693 writel (tmp, &dma->dmastat);
2694
2695 /* chaining should stop on abort, short OUT from fifo,
2696 * or (stat0 codepath) short OUT transfer.
2697 */
2698 if (!use_dma_chaining) {
2699 if ((tmp & (1 << DMA_TRANSACTION_DONE_INTERRUPT))
2700 == 0) {
2701 DEBUG (ep->dev, "%s no xact done? %08x\n",
2702 ep->ep.name, tmp);
2703 continue;
2704 }
2705 stop_dma (ep->dma);
2706 }
2707
2708 /* OUT transfers terminate when the data from the
2709 * host is in our memory. Process whatever's done.
2710 * On this path, we know transfer's last packet wasn't
2711 * less than req->length. NAK_OUT_PACKETS may be set,
2712 * or the FIFO may already be holding new packets.
2713 *
2714 * IN transfers can linger in the FIFO for a very
2715 * long time ... we ignore that for now, accounting
2716 * precisely (like PIO does) needs per-packet irqs
2717 */
2718 scan_dma_completions (ep);
2719
2720 /* disable dma on inactive queues; else maybe restart */
2721 if (list_empty (&ep->queue)) {
2722 if (use_dma_chaining)
2723 stop_dma (ep->dma);
2724 } else {
2725 tmp = readl (&dma->dmactl);
2726 if (!use_dma_chaining
2727 || (tmp & (1 << DMA_ENABLE)) == 0)
2728 restart_dma (ep);
2729 else if (ep->is_in && use_dma_chaining) {
2730 struct net2280_request *req;
320f3459 2731 __le32 dmacount;
1da177e4
LT		 2732
2733 /* the descriptor at the head of the chain
2734 * may still have VALID_BIT clear; that's
2735 * used to trigger changing DMA_FIFO_VALIDATE
2736 * (affects automagic zlp writes).
2737 */
2738 req = list_entry (ep->queue.next,
2739 struct net2280_request, queue);
2740 dmacount = req->td->dmacount;
2741 dmacount &= __constant_cpu_to_le32 (
2742 (1 << VALID_BIT)
2743 | DMA_BYTE_COUNT_MASK);
2744 if (dmacount && (dmacount & valid_bit) == 0)
2745 restart_dma (ep);
2746 }
2747 }
2748 ep->irqs++;
2749 }
2750
2751 /* NOTE: there are other PCI errors we might usefully notice.
2752 * if they appear very often, here's where to try recovering.
2753 */
2754 if (stat & PCI_ERROR_INTERRUPTS) {
2755 ERROR (dev, "pci dma error; stat %08x\n", stat);
2756 stat &= ~PCI_ERROR_INTERRUPTS;
2757 /* these are fatal errors, but "maybe" they won't
2758 * happen again ...
2759 */
2760 stop_activity (dev, dev->driver);
2761 ep0_start (dev);
2762 stat = 0;
2763 }
2764
2765 if (stat)
2766 DEBUG (dev, "unhandled irqstat1 %08x\n", stat);
2767}
2768
7d12e780 2769static irqreturn_t net2280_irq (int irq, void *_dev)
1da177e4
LT		 2770{
2771 struct net2280 *dev = _dev;
2772
658ad5e0
AS		 2773 /* shared interrupt, not ours */
2774 if (!(readl(&dev->regs->irqstat0) & (1 << INTA_ASSERTED)))
2775 return IRQ_NONE;
2776
1da177e4
LT		 2777 spin_lock (&dev->lock);
2778
2779 /* handle disconnect, dma, and more */
2780 handle_stat1_irqs (dev, readl (&dev->regs->irqstat1));
2781
2782 /* control requests and PIO */
2783 handle_stat0_irqs (dev, readl (&dev->regs->irqstat0));
2784
2785 spin_unlock (&dev->lock);
2786
2787 return IRQ_HANDLED;
2788}
2789
2790/*-------------------------------------------------------------------------*/
2791
2792static void gadget_release (struct device *_dev)
2793{
2794 struct net2280 *dev = dev_get_drvdata (_dev);
2795
2796 kfree (dev);
2797}
2798
2799/* tear down the binding between this driver and the pci device */
2800
2801static void net2280_remove (struct pci_dev *pdev)
2802{
2803 struct net2280 *dev = pci_get_drvdata (pdev);
2804
6bea476c 2805 BUG_ON(dev->driver);
1da177e4
LT		 2806
2807 /* then clean up the resources we allocated during probe() */
2808 net2280_led_shutdown (dev);
2809 if (dev->requests) {
2810 int i;
2811 for (i = 1; i < 5; i++) {
2812 if (!dev->ep [i].dummy)
2813 continue;
2814 pci_pool_free (dev->requests, dev->ep [i].dummy,
2815 dev->ep [i].td_dma);
2816 }
2817 pci_pool_destroy (dev->requests);
2818 }
2819 if (dev->got_irq)
2820 free_irq (pdev->irq, dev);
2821 if (dev->regs)
2822 iounmap (dev->regs);
2823 if (dev->region)
2824 release_mem_region (pci_resource_start (pdev, 0),
2825 pci_resource_len (pdev, 0));
2826 if (dev->enabled)
2827 pci_disable_device (pdev);
2828 device_unregister (&dev->gadget.dev);
2829 device_remove_file (&pdev->dev, &dev_attr_registers);
2830 pci_set_drvdata (pdev, NULL);
2831
2832 INFO (dev, "unbind\n");
2833
2834 the_controller = NULL;
2835}
2836
2837/* wrap this driver around the specified device, but
2838 * don't respond over USB until a gadget driver binds to us.
2839 */
2840
2841static int net2280_probe (struct pci_dev *pdev, const struct pci_device_id *id)
2842{
2843 struct net2280 *dev;
2844 unsigned long resource, len;
2845 void __iomem *base = NULL;
2846 int retval, i;
1da177e4
LT		 2847
2848 /* if you want to support more than one controller in a system,
2849 * usb_gadget_driver_{register,unregister}() must change.
2850 */
2851 if (the_controller) {
2852 dev_warn (&pdev->dev, "ignoring\n");
2853 return -EBUSY;
2854 }
2855
2856 /* alloc, and start init */
e94b1766 2857 dev = kzalloc (sizeof *dev, GFP_KERNEL);
1da177e4
LT		 2858 if (dev == NULL){
2859 retval = -ENOMEM;
2860 goto done;
2861 }
2862
9fb81ce6 2863 pci_set_drvdata (pdev, dev);
1da177e4
LT		 2864 spin_lock_init (&dev->lock);
2865 dev->pdev = pdev;
2866 dev->gadget.ops = &net2280_ops;
2867 dev->gadget.is_dualspeed = 1;
2868
2869 /* the "gadget" abstracts/virtualizes the controller */
2870 strcpy (dev->gadget.dev.bus_id, "gadget");
2871 dev->gadget.dev.parent = &pdev->dev;
2872 dev->gadget.dev.dma_mask = pdev->dev.dma_mask;
2873 dev->gadget.dev.release = gadget_release;
2874 dev->gadget.name = driver_name;
2875
2876 /* now all the pci goodies ... */
2877 if (pci_enable_device (pdev) < 0) {
901b3d75 2878 retval = -ENODEV;
1da177e4
LT		 2879 goto done;
2880 }
2881 dev->enabled = 1;
2882
2883 /* BAR 0 holds all the registers
2884 * BAR 1 is 8051 memory; unused here (note erratum 0103)
2885 * BAR 2 is fifo memory; unused here
2886 */
2887 resource = pci_resource_start (pdev, 0);
2888 len = pci_resource_len (pdev, 0);
2889 if (!request_mem_region (resource, len, driver_name)) {
2890 DEBUG (dev, "controller already in use\n");
2891 retval = -EBUSY;
2892 goto done;
2893 }
2894 dev->region = 1;
2895
901b3d75
DB		 2896 /* FIXME provide firmware download interface to put
2897 * 8051 code into the chip, e.g. to turn on PCI PM.
2898 */
2899
1da177e4
LT		 2900 base = ioremap_nocache (resource, len);
2901 if (base == NULL) {
2902 DEBUG (dev, "can't map memory\n");
2903 retval = -EFAULT;
2904 goto done;
2905 }
2906 dev->regs = (struct net2280_regs __iomem *) base;
2907 dev->usb = (struct net2280_usb_regs __iomem *) (base + 0x0080);
2908 dev->pci = (struct net2280_pci_regs __iomem *) (base + 0x0100);
2909 dev->dma = (struct net2280_dma_regs __iomem *) (base + 0x0180);
2910 dev->dep = (struct net2280_dep_regs __iomem *) (base + 0x0200);
2911 dev->epregs = (struct net2280_ep_regs __iomem *) (base + 0x0300);
2912
2913 /* put into initial config, link up all endpoints */
2914 writel (0, &dev->usb->usbctl);
2915 usb_reset (dev);
2916 usb_reinit (dev);
2917
2918 /* irq setup after old hardware is cleaned up */
2919 if (!pdev->irq) {
2920 ERROR (dev, "No IRQ. Check PCI setup!\n");
2921 retval = -ENODEV;
2922 goto done;
2923 }
c6387a48 2924
d54b5caa 2925 if (request_irq (pdev->irq, net2280_irq, IRQF_SHARED, driver_name, dev)
1da177e4 2926 != 0) {
c6387a48 2927 ERROR (dev, "request interrupt %d failed\n", pdev->irq);
1da177e4
LT		 2928 retval = -EBUSY;
2929 goto done;
2930 }
2931 dev->got_irq = 1;
2932
2933 /* DMA setup */
2934 /* NOTE: we know only the 32 LSBs of dma addresses may be nonzero */
2935 dev->requests = pci_pool_create ("requests", pdev,
2936 sizeof (struct net2280_dma),
2937 0 /* no alignment requirements */,
2938 0 /* or page-crossing issues */);
2939 if (!dev->requests) {
2940 DEBUG (dev, "can't get request pool\n");
2941 retval = -ENOMEM;
2942 goto done;
2943 }
2944 for (i = 1; i < 5; i++) {
2945 struct net2280_dma *td;
2946
2947 td = pci_pool_alloc (dev->requests, GFP_KERNEL,
2948 &dev->ep [i].td_dma);
2949 if (!td) {
2950 DEBUG (dev, "can't get dummy %d\n", i);
2951 retval = -ENOMEM;
2952 goto done;
2953 }
2954 td->dmacount = 0; /* not VALID */
2955 td->dmaaddr = __constant_cpu_to_le32 (DMA_ADDR_INVALID);
2956 td->dmadesc = td->dmaaddr;
2957 dev->ep [i].dummy = td;
2958 }
2959
2960 /* enable lower-overhead pci memory bursts during DMA */
2961 writel ( (1 << DMA_MEMORY_WRITE_AND_INVALIDATE_ENABLE)
2962 // 256 write retries may not be enough...
2963 // | (1 << PCI_RETRY_ABORT_ENABLE)
2964 | (1 << DMA_READ_MULTIPLE_ENABLE)
2965 | (1 << DMA_READ_LINE_ENABLE)
2966 , &dev->pci->pcimstctl);
2967 /* erratum 0115 shouldn't appear: Linux inits PCI_LATENCY_TIMER */
2968 pci_set_master (pdev);
2969 pci_set_mwi (pdev);
2970
2971 /* ... also flushes any posted pci writes */
2972 dev->chiprev = get_idx_reg (dev->regs, REG_CHIPREV) & 0xffff;
2973
2974 /* done */
1da177e4 2975 INFO (dev, "%s\n", driver_desc);
c6387a48
DM		 2976 INFO (dev, "irq %d, pci mem %p, chip rev %04x\n",
2977 pdev->irq, base, dev->chiprev);
1da177e4
LT		 2978 INFO (dev, "version: " DRIVER_VERSION "; dma %s\n",
2979 use_dma
2980 ? (use_dma_chaining ? "chaining" : "enabled")
2981 : "disabled");
2982 the_controller = dev;
2983
b3899dac
JG		 2984 retval = device_register (&dev->gadget.dev);
2985 if (retval) goto done;
2986 retval = device_create_file (&pdev->dev, &dev_attr_registers);
2987 if (retval) goto done;
1da177e4
LT		 2988
2989 return 0;
2990
2991done:
2992 if (dev)
2993 net2280_remove (pdev);
2994 return retval;
2995}
2996
2d61bde7
AS		 2997/* make sure the board is quiescent; otherwise it will continue
2998 * generating IRQs across the upcoming reboot.
2999 */
3000
3001static void net2280_shutdown (struct pci_dev *pdev)
3002{
3003 struct net2280 *dev = pci_get_drvdata (pdev);
3004
3005 /* disable IRQs */
3006 writel (0, &dev->regs->pciirqenb0);
3007 writel (0, &dev->regs->pciirqenb1);
3008
3009 /* disable the pullup so the host will think we're gone */
3010 writel (0, &dev->usb->usbctl);
3011}
3012
1da177e4
LT		 3013
3014/*-------------------------------------------------------------------------*/
3015
901b3d75
DB		 3016static const struct pci_device_id pci_ids [] = { {
3017 .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
3018 .class_mask = ~0,
1da177e4
LT		 3019 .vendor = 0x17cc,
3020 .device = 0x2280,
3021 .subvendor = PCI_ANY_ID,
3022 .subdevice = PCI_ANY_ID,
950ee4c8 3023}, {
901b3d75
DB		 3024 .class = ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
3025 .class_mask = ~0,
950ee4c8
GL		 3026 .vendor = 0x17cc,
3027 .device = 0x2282,
3028 .subvendor = PCI_ANY_ID,
3029 .subdevice = PCI_ANY_ID,
1da177e4
LT		 3030
3031}, { /* end: all zeroes */ }
3032};
3033MODULE_DEVICE_TABLE (pci, pci_ids);
3034
3035/* pci driver glue; this is a "new style" PCI driver module */
3036static struct pci_driver net2280_pci_driver = {
3037 .name = (char *) driver_name,
3038 .id_table = pci_ids,
3039
3040 .probe = net2280_probe,
3041 .remove = net2280_remove,
2d61bde7 3042 .shutdown = net2280_shutdown,
1da177e4
LT		 3043
3044 /* FIXME add power management support */
3045};
3046
3047MODULE_DESCRIPTION (DRIVER_DESC);
3048MODULE_AUTHOR ("David Brownell");
3049MODULE_LICENSE ("GPL");
3050
3051static int __init init (void)
3052{
3053 if (!use_dma)
3054 use_dma_chaining = 0;
3055 return pci_register_driver (&net2280_pci_driver);
3056}
3057module_init (init);
3058
3059static void __exit cleanup (void)
3060{
3061 pci_unregister_driver (&net2280_pci_driver);
3062}
3063module_exit (cleanup);
Ubuntu Artful kernel mirror