source: trunk/target/linux/adm5120-2.6/files/drivers/usb/host/adm5120-hcd.c @ 7120

Last change on this file since 7120 was 7120, checked in by florian, 9 years ago

Fix some HCD driver warnings

File size: 20.9 KB
Line 
1/*
2 *      HCD driver for ADM5120 SoC
3 *
4 *      Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
5 *
6 *      Based on the ADMtek 2.4 driver
7 *      (C) Copyright 2003 Junius Chen <juniusc@admtek.com.tw>
8 *      Which again was based on the ohci and uhci drivers.
9 */
10
11#include <linux/module.h>
12#include <linux/delay.h>
13#include <linux/debugfs.h>
14#include <linux/seq_file.h>
15#include <linux/errno.h>
16#include <linux/init.h>
17#include <linux/list.h>
18#include <linux/usb.h>
19#include <linux/platform_device.h>
20
21#include <asm/io.h>
22#include <asm/irq.h>
23#include <asm/system.h>
24#include <asm/byteorder.h>
25#include <asm/mach-adm5120/adm5120_info.h>
26
27#include "../core/hcd.h"
28
29MODULE_DESCRIPTION("ADM5120 USB Host Controller Driver");
30MODULE_LICENSE("GPL");
31MODULE_AUTHOR("Jeroen Vreeken (pe1rxq@amsat.org)");
32
33#define ADMHCD_REG_CONTROL              0x00
34#define ADMHCD_REG_INTSTATUS            0x04
35#define ADMHCD_REG_INTENABLE            0x08
36#define ADMHCD_REG_HOSTCONTROL          0x10
37#define ADMHCD_REG_FMINTERVAL           0x18
38#define ADMHCD_REG_FMNUMBER             0x1c
39#define ADMHCD_REG_LSTHRESH             0x70
40#define ADMHCD_REG_RHDESCR              0x74
41#define ADMHCD_REG_PORTSTATUS0          0x78
42#define ADMHCD_REG_PORTSTATUS1          0x7c
43#define ADMHCD_REG_HOSTHEAD             0x80
44
45
46#define ADMHCD_NUMPORTS         2
47
48#define ADMHCD_HOST_EN          0x00000001      /* Host enable */
49#define ADMHCD_SW_INTREQ        0x00000002      /* request software int */
50#define ADMHCD_SW_RESET         0x00000008      /* Reset */
51
52#define ADMHCD_INT_TD           0x00100000      /* TD completed */
53#define ADMHCD_INT_SW           0x20000000      /* software interrupt */
54#define ADMHCD_INT_FATAL        0x40000000      /* Fatal interrupt */
55#define ADMHCD_INT_ACT          0x80000000      /* Interrupt active */
56
57#define ADMHCD_STATE_RST        0x00000000      /* bus state reset */
58#define ADMHCD_STATE_RES        0x00000001      /* bus state resume */
59#define ADMHCD_STATE_OP         0x00000002      /* bus state operational */
60#define ADMHCD_STATE_SUS        0x00000003      /* bus state suspended */
61#define ADMHCD_DMA_EN           0x00000004      /* enable dma engine */
62
63#define ADMHCD_NPS              0x00000020      /* No Power Switch */
64#define ADMHCD_LPSC             0x04000000      /* Local power switch change */
65
66#define ADMHCD_CCS              0x00000001      /* current connect status */
67#define ADMHCD_PES              0x00000002      /* port enable status */
68#define ADMHCD_PSS              0x00000004      /* port suspend status */
69#define ADMHCD_POCI             0x00000008      /* port overcurrent indicator */
70#define ADMHCD_PRS              0x00000010      /* port reset status */
71#define ADMHCD_PPS              0x00000100      /* port power status */
72#define ADMHCD_LSDA             0x00000200      /* low speed device attached */
73#define ADMHCD_CSC              0x00010000      /* connect status change */
74#define ADMHCD_PESC             0x00020000      /* enable status change */
75#define ADMHCD_PSSC             0x00040000      /* suspend status change */
76#define ADMHCD_OCIC             0x00080000      /* overcurrent change*/
77#define ADMHCD_PRSC             0x00100000      /* reset status change */
78
79
80struct admhcd_ed {
81        /* Don't change first four, they used for DMA */
82        u32                             control;
83        struct admhcd_td                *tail;
84        struct admhcd_td                *head;
85        struct admhcd_ed                *next;
86        /* the rest is for the driver only: */
87        struct admhcd_td                *cur;
88        struct usb_host_endpoint        *ep;
89        struct urb                      *urb;
90        struct admhcd_ed                *real;
91} __attribute__ ((packed));
92
93#define ADMHCD_ED_EPSHIFT       7               /* Shift for endpoint number */
94#define ADMHCD_ED_INT           0x00000800      /* Is this an int endpoint */
95#define ADMHCD_ED_SPEED         0x00002000      /* Is it a high speed dev? */
96#define ADMHCD_ED_SKIP          0x00004000      /* Skip this ED */
97#define ADMHCD_ED_FORMAT        0x00008000      /* Is this an isoc endpoint */
98#define ADMHCD_ED_MAXSHIFT      16              /* Shift for max packet size */
99
100struct admhcd_td {
101        /* Don't change first four, they are used for DMA */
102        u32                     control;
103        u32                     buffer;
104        u32                     buflen;
105        struct admhcd_td        *next;
106        /* the rest is for the driver only: */
107        struct urb              *urb;
108        struct admhcd_td        *real;
109} __attribute__ ((packed));
110
111#define ADMHCD_TD_OWN           0x80000000
112#define ADMHCD_TD_TOGGLE        0x00000000
113#define ADMHCD_TD_DATA0         0x01000000
114#define ADMHCD_TD_DATA1         0x01800000
115#define ADMHCD_TD_OUT           0x00200000
116#define ADMHCD_TD_IN            0x00400000
117#define ADMHCD_TD_SETUP         0x00000000
118#define ADMHCD_TD_ISO           0x00010000
119#define ADMHCD_TD_R             0x00040000
120#define ADMHCD_TD_INTEN         0x00010000
121
122static int admhcd_td_err[16] = {
123        0,              /* No */
124        -EREMOTEIO,             /* CRC */
125        -EREMOTEIO,     /* bit stuff */
126        -EREMOTEIO,             /* data toggle */
127        -EPIPE,         /* stall */
128        -ETIMEDOUT,     /* timeout */
129        -EPROTO,        /* pid err */
130        -EPROTO,        /* unexpected pid */
131        -EREMOTEIO,     /* data overrun */
132        -EREMOTEIO,     /* data underrun */
133        -ETIMEDOUT,     /* 1010 */
134        -ETIMEDOUT,     /* 1011 */
135        -EREMOTEIO,     /* buffer overrun */
136        -EREMOTEIO,     /* buffer underrun */
137        -ETIMEDOUT,     /* 1110 */
138        -ETIMEDOUT,     /* 1111 */
139};
140
141#define ADMHCD_TD_ERRMASK       0x38000000
142#define ADMHCD_TD_ERRSHIFT      27
143
144#define TD(td)  ((struct admhcd_td *)(((u32)(td)) & ~0xf))
145#define ED(ed)  ((struct admhcd_ed *)(((u32)(ed)) & ~0xf))
146
147struct admhcd {
148        spinlock_t      lock;
149
150        void __iomem *addr_reg;
151        void __iomem *data_reg;
152        /* Root hub registers */
153        u32 rhdesca;
154        u32 rhdescb;
155        u32 rhstatus;
156        u32 rhport[2];
157
158        /* async schedule: control, bulk */
159        struct list_head async;
160        u32             base;
161        u32             dma_en;
162        unsigned long   flags;
163
164};
165
166static inline struct admhcd *hcd_to_admhcd(struct usb_hcd *hcd)
167{
168        return (struct admhcd *)(hcd->hcd_priv);
169}
170
171static inline struct usb_hcd *admhcd_to_hcd(struct admhcd *admhcd)
172{
173        return container_of((void *)admhcd, struct usb_hcd, hcd_priv);
174}
175
176static char hcd_name[] = "adm5120-hcd";
177
178static u32 admhcd_reg_get(struct admhcd *ahcd, int reg)
179{
180        return *(volatile u32 *)KSEG1ADDR(ahcd->base+reg);
181}
182
183static void admhcd_reg_set(struct admhcd *ahcd, int reg, u32 val)
184{
185        *(volatile u32 *)KSEG1ADDR(ahcd->base+reg) = val;
186}
187
188static void admhcd_lock(struct admhcd *ahcd)
189{
190        spin_lock_irqsave(&ahcd->lock, ahcd->flags);
191        ahcd->dma_en = admhcd_reg_get(ahcd, ADMHCD_REG_HOSTCONTROL) &
192            ADMHCD_DMA_EN;
193        admhcd_reg_set(ahcd, ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP);
194}
195
196static void admhcd_unlock(struct admhcd *ahcd)
197{
198        admhcd_reg_set(ahcd, ADMHCD_REG_HOSTCONTROL,
199            ADMHCD_STATE_OP | ahcd->dma_en);
200        spin_unlock_irqrestore(&ahcd->lock, ahcd->flags);
201}
202
203static struct admhcd_td *admhcd_td_alloc(struct admhcd_ed *ed, struct urb *urb)
204{
205        struct admhcd_td *tdn, *td;
206
207        tdn = kmalloc(sizeof(struct admhcd_td), GFP_ATOMIC);
208        if (!tdn)
209                return NULL;
210        tdn->real = tdn;
211        tdn = (struct admhcd_td *)KSEG1ADDR(tdn);
212        memset(tdn, 0, sizeof(struct admhcd_td));
213        if (ed->cur == NULL) {
214                ed->cur = tdn;
215                ed->head = tdn;
216                ed->tail = tdn;
217                td = tdn;
218        } else {
219                /* Supply back the old tail and link in new td as tail */
220                td = TD(ed->tail);
221                TD(ed->tail)->next = tdn;
222                ed->tail = tdn;
223        }
224        td->urb = urb;
225
226        return td;
227}
228
229static void admhcd_td_free(struct admhcd_ed *ed, struct urb *urb)
230{
231        struct admhcd_td *td, **tdp;
232
233        if (urb == NULL)
234                ed->control |= ADMHCD_ED_SKIP;
235        tdp = &ed->cur;
236        td = ed->cur;
237        do {
238                if (td->urb == urb)
239                        break;
240                tdp = &td->next;
241                td = TD(td->next);
242        } while (td);
243        while (td && td->urb == urb) {
244                *tdp = TD(td->next);
245                kfree(td->real);
246                td = *tdp;
247        }
248}
249
250/* Find an endpoint's descriptor, if needed allocate a new one and link it
251   in the DMA chain
252 */
253static struct admhcd_ed *admhcd_get_ed(struct admhcd *ahcd,
254    struct usb_host_endpoint *ep, struct urb *urb)
255{
256        struct admhcd_ed *hosthead;
257        struct admhcd_ed *found = NULL, *ed = NULL;
258        unsigned int pipe = urb->pipe;
259
260        admhcd_lock(ahcd);
261        hosthead = (struct admhcd_ed *)admhcd_reg_get(ahcd, ADMHCD_REG_HOSTHEAD);
262        if (hosthead) {
263                for (ed = hosthead;; ed = ED(ed->next)) {
264                        if (ed->ep == ep) {
265                                found = ed;
266                                break;
267                        }
268                        if (ED(ed->next) == hosthead)
269                                break;
270                }
271        }
272        if (!found) {
273                found = kmalloc(sizeof(struct admhcd_ed), GFP_ATOMIC);
274                if (!found)
275                        goto out;
276                memset(found, 0, sizeof(struct admhcd_ed));
277                found->real = found;
278                found->ep = ep;
279                found = (struct admhcd_ed *)KSEG1ADDR(found);
280                found->control = usb_pipedevice(pipe) |
281                    (usb_pipeendpoint(pipe) << ADMHCD_ED_EPSHIFT) |
282                    (usb_pipeint(pipe) ? ADMHCD_ED_INT : 0) |
283                    (urb->dev->speed == USB_SPEED_FULL ? ADMHCD_ED_SPEED : 0) |
284                    (usb_pipeisoc(pipe) ? ADMHCD_ED_FORMAT : 0) |
285                    (usb_maxpacket(urb->dev, pipe, usb_pipeout(pipe)) << ADMHCD_ED_MAXSHIFT);
286                /* Alloc first dummy td */
287                admhcd_td_alloc(found, NULL);
288                if (hosthead) {
289                        found->next = hosthead;
290                        ed->next = found;
291                } else {
292                        found->next = found;
293                        admhcd_reg_set(ahcd, ADMHCD_REG_HOSTHEAD, (u32)found);
294                }
295        }
296out:
297        admhcd_unlock(ahcd);
298        return found;
299}
300
301static struct admhcd_td *admhcd_td_fill(u32 control, struct admhcd_td *td,
302    dma_addr_t data, int len)
303{
304        td->buffer = data;
305        td->buflen = len;
306        td->control = control;
307        return TD(td->next);
308}
309
310static void admhcd_ed_start(struct admhcd *ahcd, struct admhcd_ed *ed)
311{
312        struct admhcd_td *td = ed->cur;
313
314        if (ed->urb)
315                return;
316        if (td->urb) {
317                ed->urb = td->urb;
318                while (1) {
319                        td->control |= ADMHCD_TD_OWN;
320                        if (TD(td->next)->urb != td->urb) {
321                                td->buflen |= ADMHCD_TD_INTEN;
322                                break;
323                        }
324                        td = TD(td->next);
325                }
326        }
327        ed->head = TD(ed->head);
328        ahcd->dma_en |= ADMHCD_DMA_EN;
329}
330
331static irqreturn_t adm5120hcd_irq(int irq, void *ptr, struct pt_regs *regs)
332{
333        struct usb_hcd *hcd = (struct usb_hcd *)ptr;
334        struct admhcd *ahcd = hcd_to_admhcd(hcd);
335        u32 intstatus;
336
337        intstatus = admhcd_reg_get(ahcd, ADMHCD_REG_INTSTATUS);
338        if (intstatus & ADMHCD_INT_FATAL) {
339                admhcd_reg_set(ahcd, ADMHCD_REG_INTSTATUS, ADMHCD_INT_FATAL);
340                //
341        }
342        if (intstatus & ADMHCD_INT_SW) {
343                admhcd_reg_set(ahcd, ADMHCD_REG_INTSTATUS, ADMHCD_INT_SW);
344                //
345        }
346        if (intstatus & ADMHCD_INT_TD) {
347                struct admhcd_ed *ed, *head;
348
349                admhcd_reg_set(ahcd, ADMHCD_REG_INTSTATUS, ADMHCD_INT_TD);
350
351                head = (struct admhcd_ed *)admhcd_reg_get(ahcd, ADMHCD_REG_HOSTHEAD);
352                ed = head;
353                if (ed) do {
354                        /* Is it a finished TD? */
355                        if (ed->urb && !(ed->cur->control & ADMHCD_TD_OWN)) {
356                                struct admhcd_td *td;
357                                int error;
358
359                                td = ed->cur;
360                                error = (td->control & ADMHCD_TD_ERRMASK) >>
361                                    ADMHCD_TD_ERRSHIFT;
362                                ed->urb->status = admhcd_td_err[error];
363                                admhcd_td_free(ed, ed->urb);
364                                // Calculate real length!!!
365                                ed->urb->actual_length = ed->urb->transfer_buffer_length;
366                                ed->urb->hcpriv = NULL;
367                                usb_hcd_giveback_urb(hcd, ed->urb);
368                                ed->urb = NULL;
369                        }
370                        admhcd_ed_start(ahcd, ed);
371                        ed = ED(ed->next);
372                } while (ed != head);
373        }
374
375        return IRQ_HANDLED;
376}
377
378static int admhcd_urb_enqueue(struct usb_hcd *hcd, struct usb_host_endpoint *ep,
379    struct urb *urb, gfp_t mem_flags)
380{
381        struct admhcd *ahcd = hcd_to_admhcd(hcd);
382        struct admhcd_ed *ed;
383        struct admhcd_td *td;
384        int size = 0, i, zero = 0, ret = 0;
385        unsigned int pipe = urb->pipe, toggle = 0;
386        dma_addr_t data = (dma_addr_t)urb->transfer_buffer;
387        int data_len = urb->transfer_buffer_length;
388
389        ed = admhcd_get_ed(ahcd, ep, urb);
390        if (!ed)
391                return -ENOMEM;
392
393        switch(usb_pipetype(pipe)) {
394                case PIPE_CONTROL:
395                        size = 2;
396                case PIPE_INTERRUPT:
397                case PIPE_BULK:
398                default:
399                        size += urb->transfer_buffer_length / 4096;
400                        if (urb->transfer_buffer_length % 4096)
401                                size++;
402                        if (size == 0)
403                                size++;
404                        else if (urb->transfer_flags & URB_ZERO_PACKET &&
405                            !(urb->transfer_buffer_length %
406                              usb_maxpacket(urb->dev, pipe, usb_pipeout(pipe)))) {
407                                size++;
408                                zero = 1;
409                        }
410                        break;
411                case PIPE_ISOCHRONOUS:
412                        size = urb->number_of_packets;
413                        break;
414        }
415
416        admhcd_lock(ahcd);
417        /* Remember the first td */
418        td = admhcd_td_alloc(ed, urb);
419        if (!td) {
420                ret = -ENOMEM;
421                goto out;
422        }
423        /* Allocate additionall tds first */
424        for (i = 1; i < size; i++) {
425                if (admhcd_td_alloc(ed, urb) == NULL) {
426                        admhcd_td_free(ed, urb);
427                        ret = -ENOMEM;
428                        goto out;
429                }
430        }
431
432        if (usb_gettoggle(urb->dev, usb_pipeendpoint(pipe), usb_pipeout(pipe)))
433                toggle = ADMHCD_TD_TOGGLE;
434        else {
435                toggle = ADMHCD_TD_DATA0;
436                usb_settoggle(urb->dev, usb_pipeendpoint(pipe),
437                    usb_pipeout(pipe), 1);
438        }
439
440        switch(usb_pipetype(pipe)) {
441                case PIPE_CONTROL:
442                        td = admhcd_td_fill(ADMHCD_TD_SETUP | ADMHCD_TD_DATA0,
443                            td, (dma_addr_t)urb->setup_packet, 8);
444                        while (data_len > 0) {
445                                td = admhcd_td_fill(ADMHCD_TD_DATA1
446                                    | ADMHCD_TD_R |
447                                    (usb_pipeout(pipe) ?
448                                    ADMHCD_TD_OUT : ADMHCD_TD_IN), td,
449                                    data, data_len % 4097);
450                                data_len -= 4096;
451                        }
452                        admhcd_td_fill(ADMHCD_TD_DATA1 | (usb_pipeout(pipe) ?
453                            ADMHCD_TD_IN : ADMHCD_TD_OUT), td,
454                            data, 0);
455                        break;
456                case PIPE_INTERRUPT:
457                case PIPE_BULK:
458                        //info ok for interrupt?
459                        i = 0;
460                        while(data_len > 4096) {
461                                td = admhcd_td_fill((usb_pipeout(pipe) ?
462                                    ADMHCD_TD_OUT :
463                                    ADMHCD_TD_IN | ADMHCD_TD_R) |
464                                    (i ? ADMHCD_TD_TOGGLE : toggle), td,
465                                    data, 4096);
466                                data += 4096;
467                                data_len -= 4096;
468                                i++;
469                        }
470                        td = admhcd_td_fill((usb_pipeout(pipe) ?
471                            ADMHCD_TD_OUT : ADMHCD_TD_IN) |
472                            (i ? ADMHCD_TD_TOGGLE : toggle), td, data, data_len);
473                        i++;
474                        if (zero)
475                                admhcd_td_fill((usb_pipeout(pipe) ?
476                                    ADMHCD_TD_OUT : ADMHCD_TD_IN) |
477                                    (i ? ADMHCD_TD_TOGGLE : toggle), td, 0, 0);
478                        break;
479                case PIPE_ISOCHRONOUS:
480                        for (i = 0; i < urb->number_of_packets; i++) {
481                                td = admhcd_td_fill(ADMHCD_TD_ISO |
482                                    ((urb->start_frame + i) & 0xffff), td,
483                                    data + urb->iso_frame_desc[i].offset,
484                                    urb->iso_frame_desc[i].length);
485                        }
486                        break;
487        }
488        urb->hcpriv = ed;
489        admhcd_ed_start(ahcd, ed);
490out:
491        admhcd_unlock(ahcd);
492        return ret;
493}
494
495static int admhcd_urb_dequeue(struct usb_hcd *hcd, struct urb *urb)
496{
497        struct admhcd *ahcd = hcd_to_admhcd(hcd);
498        struct admhcd_ed *ed;
499
500        admhcd_lock(ahcd);
501
502        ed = urb->hcpriv;
503        if (ed && ed->urb != urb)
504                admhcd_td_free(ed, urb);
505
506        admhcd_unlock(ahcd);
507        return 0;
508}
509
510static void admhcd_endpoint_disable(struct usb_hcd *hcd, struct usb_host_endpoint *ep)
511{
512        struct admhcd *ahcd = hcd_to_admhcd(hcd);
513        struct admhcd_ed *ed, *edt, *head;
514
515        admhcd_lock(ahcd);
516
517        head = (struct admhcd_ed *)admhcd_reg_get(ahcd, ADMHCD_REG_HOSTHEAD);
518        if (!head)
519                goto out;
520        for (ed = head; ED(ed->next) != head; ed = ED(ed->next))
521                if (ed->ep == ep)
522                        break;
523        if (ed->ep != ep)
524                goto out;
525        while (ed->cur)
526                admhcd_td_free(ed, ed->cur->urb);
527        if (head == ed) {
528                if (ED(ed->next) == ed) {
529                        admhcd_reg_set(ahcd, ADMHCD_REG_HOSTHEAD, 0);
530                        ahcd->dma_en = 0;
531                        goto out_free;
532                }
533                head = ED(ed->next);
534                for (edt = head; ED(edt->next) != head; edt = ED(edt->next));
535                edt->next = ED(ed->next);
536                admhcd_reg_set(ahcd, ADMHCD_REG_HOSTHEAD, (u32)ed->next);
537                goto out_free;
538        }
539        for (edt = head; edt->next != ed; edt = edt->next);
540        edt->next = ed->next;
541out_free:
542        kfree(ed->real);
543out:
544        admhcd_unlock(ahcd);
545}
546
547static int admhcd_get_frame_number(struct usb_hcd *hcd)
548{
549        struct admhcd *ahcd = hcd_to_admhcd(hcd);
550
551        return admhcd_reg_get(ahcd, ADMHCD_REG_FMNUMBER) & 0x0000ffff;
552}
553
554static int admhcd_hub_status_data(struct usb_hcd *hcd, char *buf)
555{
556        struct admhcd *ahcd = hcd_to_admhcd(hcd);
557        int port;
558
559        *buf = 0;
560        for (port = 0; port < ADMHCD_NUMPORTS; port++) {
561                if (admhcd_reg_get(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4) &
562                    (ADMHCD_CSC | ADMHCD_PESC | ADMHCD_PSSC | ADMHCD_OCIC |
563                     ADMHCD_PRSC))
564                        *buf |= (1 << (port + 1));
565        }
566        return !!*buf;
567}
568
569static __u8 root_hub_hub_des[] = {
570        0x09,           /* __u8  bLength; */
571        0x29,           /* __u8  bDescriptorType; Hub-descriptor */
572        0x02,           /* __u8  bNbrPorts; */
573        0x0a, 0x00,     /* __u16 wHubCharacteristics; */
574        0x01,           /* __u8  bPwrOn2pwrGood; 2ms */
575        0x00,           /* __u8  bHubContrCurrent; 0mA */
576        0x00,           /* __u8  DeviceRemovable; */
577        0xff,           /* __u8  PortPwrCtrlMask; */
578};
579
580static int admhcd_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
581    u16 wIndex, char *buf, u16 wLength)
582{
583        struct admhcd *ahcd = hcd_to_admhcd(hcd);
584        int retval = 0, len;
585        unsigned int port = wIndex -1;
586
587        switch (typeReq) {
588
589        case GetHubStatus:
590                *(__le32 *)buf = cpu_to_le32(0);
591                break;
592        case GetPortStatus:
593                if (port >= ADMHCD_NUMPORTS)
594                        goto err;
595                *(__le32 *)buf = cpu_to_le32(
596                    admhcd_reg_get(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4));
597                break;
598        case SetHubFeature:             /* We don't implement these */
599        case ClearHubFeature:
600                switch (wValue) {
601                case C_HUB_OVER_CURRENT:
602                case C_HUB_LOCAL_POWER:
603                        break;
604                default:
605                        goto err;
606                }
607        case SetPortFeature:
608                if (port >= ADMHCD_NUMPORTS)
609                        goto err;
610
611                switch (wValue) {
612                case USB_PORT_FEAT_SUSPEND:
613                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
614                            ADMHCD_PSS);
615                        break;
616                case USB_PORT_FEAT_RESET:
617                        if (admhcd_reg_get(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4)
618                            & ADMHCD_CCS) {
619                                admhcd_reg_set(ahcd,
620                                    ADMHCD_REG_PORTSTATUS0 + port*4,
621                                    ADMHCD_PRS | ADMHCD_CSC);
622                                mdelay(50);
623                                admhcd_reg_set(ahcd,
624                                    ADMHCD_REG_PORTSTATUS0 + port*4,
625                                    ADMHCD_PES | ADMHCD_CSC);
626                        }
627                        break;
628                case USB_PORT_FEAT_POWER:
629                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
630                            ADMHCD_PPS);
631                        break;
632                default:
633                        goto err;
634                }
635                break;
636        case ClearPortFeature:
637                if (port >= ADMHCD_NUMPORTS)
638                        goto err;
639
640                switch (wValue) {
641                case USB_PORT_FEAT_ENABLE:
642                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
643                            ADMHCD_CCS);
644                        break;
645                case USB_PORT_FEAT_C_ENABLE:
646                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
647                            ADMHCD_PESC);
648                        break;
649                case USB_PORT_FEAT_SUSPEND:
650                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
651                            ADMHCD_POCI);
652                        break;
653                case USB_PORT_FEAT_C_SUSPEND:
654                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
655                            ADMHCD_PSSC);
656                case USB_PORT_FEAT_POWER:
657                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
658                            ADMHCD_LSDA);
659                        break;
660                case USB_PORT_FEAT_C_CONNECTION:
661                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
662                            ADMHCD_CSC);
663                        break;
664                case USB_PORT_FEAT_C_OVER_CURRENT:
665                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
666                            ADMHCD_OCIC);
667                        break;
668                case USB_PORT_FEAT_C_RESET:
669                        admhcd_reg_set(ahcd, ADMHCD_REG_PORTSTATUS0 + port*4,
670                            ADMHCD_PRSC);
671                        break;
672                default:
673                        goto err;
674                }
675                break;
676        case GetHubDescriptor:
677                len = min_t(unsigned int, sizeof(root_hub_hub_des), wLength);
678                memcpy(buf, root_hub_hub_des, len);
679                break;
680        default:
681err:
682                retval = -EPIPE;
683        }
684
685        return retval;
686}
687
688static struct hc_driver adm5120_hc_driver = {
689        .description =          hcd_name,
690        .product_desc =         "ADM5120 HCD",
691        .hcd_priv_size =        sizeof(struct admhcd),
692        .flags =                HCD_USB11,
693        .urb_enqueue =          admhcd_urb_enqueue,
694        .urb_dequeue =          admhcd_urb_dequeue,
695        .endpoint_disable =     admhcd_endpoint_disable,
696        .get_frame_number =     admhcd_get_frame_number,
697        .hub_status_data =      admhcd_hub_status_data,
698        .hub_control =          admhcd_hub_control,
699};
700
701#define resource_len(r) (((r)->end - (r)->start) + 1)
702
703static int __init adm5120hcd_probe(struct platform_device *pdev)
704{
705        struct usb_hcd *hcd;
706        struct admhcd *ahcd;
707        struct resource *addr, *data;
708        void __iomem *addr_reg;
709        void __iomem *data_reg;
710        int irq, err = 0;
711
712        if (pdev->num_resources < 3) {
713                err = -ENODEV;
714                goto out;
715        }
716
717        data = platform_get_resource(pdev, IORESOURCE_MEM, 0);
718        addr = platform_get_resource(pdev, IORESOURCE_MEM, 1);
719        irq = platform_get_irq(pdev, 0);
720
721        if (!addr || !data || irq < 0) {
722                err = -ENODEV;
723                goto out;
724        }
725
726        if (pdev->dev.dma_mask) {
727                printk(KERN_DEBUG "DMA not supported\n");
728                err = -EINVAL;
729                goto out;
730        }
731
732        if (!request_mem_region(addr->start, 2, hcd_name)) {
733                err = -EBUSY;
734                goto out;
735        }
736        addr_reg = ioremap(addr->start, resource_len(addr));
737        if (addr_reg == NULL) {
738                err = -ENOMEM;
739                goto out_mem;
740        }
741        if (!request_mem_region(data->start, 2, hcd_name)) {
742                err = -EBUSY;
743                goto out_unmap;
744        }
745        data_reg = ioremap(data->start, resource_len(data));
746        if (data_reg == NULL) {
747                err = -ENOMEM;
748                goto out_mem;
749        }
750
751
752        hcd = usb_create_hcd(&adm5120_hc_driver, &pdev->dev, pdev->dev.bus_id);
753        if (!hcd)
754                goto out_mem;
755
756        ahcd = hcd_to_admhcd(hcd);
757        ahcd->data_reg = data_reg;
758        ahcd->addr_reg = addr_reg;
759        spin_lock_init(&ahcd->lock);
760        INIT_LIST_HEAD(&ahcd->async);
761
762        /* Initialise the HCD registers */
763        admhcd_reg_set(ahcd, ADMHCD_REG_INTENABLE, 0);
764        mdelay(10);
765        admhcd_reg_set(ahcd, ADMHCD_REG_CONTROL, ADMHCD_SW_RESET);
766        while (admhcd_reg_get(ahcd, ADMHCD_REG_CONTROL) & ADMHCD_SW_RESET)
767                mdelay(1);
768
769        admhcd_reg_set(ahcd, ADMHCD_REG_CONTROL, ADMHCD_HOST_EN);
770        admhcd_reg_set(ahcd, ADMHCD_REG_HOSTHEAD, 0x00000000);
771        admhcd_reg_set(ahcd, ADMHCD_REG_FMINTERVAL, 0x20002edf);
772        admhcd_reg_set(ahcd, ADMHCD_REG_LSTHRESH, 0x628);
773        admhcd_reg_set(ahcd, ADMHCD_REG_INTENABLE,
774            ADMHCD_INT_ACT | ADMHCD_INT_FATAL | ADMHCD_INT_SW | ADMHCD_INT_TD);
775        admhcd_reg_set(ahcd, ADMHCD_REG_INTSTATUS,
776            ADMHCD_INT_ACT | ADMHCD_INT_FATAL | ADMHCD_INT_SW | ADMHCD_INT_TD);
777        admhcd_reg_set(ahcd, ADMHCD_REG_RHDESCR, ADMHCD_NPS | ADMHCD_LPSC);
778        admhcd_reg_set(ahcd, ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP);
779
780        err = usb_add_hcd(hcd, irq, IRQF_DISABLED);
781        if (err)
782                goto out_dev;
783
784        return 0;
785
786out_dev:
787        usb_put_hcd(hcd);
788out_unmap:
789        iounmap(addr_reg);
790out_mem:
791        release_mem_region(addr->start, 2);
792out:
793        return err;
794}
795
796static int __init_or_module adm5120hcd_remove(struct platform_device *pdev)
797{
798        struct usb_hcd *hcd = platform_get_drvdata(pdev);
799        struct admhcd *ahcd;
800
801        if (!hcd)
802                return 0;
803        ahcd = hcd_to_admhcd(hcd);
804        usb_remove_hcd(hcd);
805
806        usb_put_hcd(hcd);
807        return 0;
808}
809
810static struct platform_driver adm5120hcd_driver = {
811        .probe =        adm5120hcd_probe,
812        .remove =       adm5120hcd_remove,
813        .driver =       {
814                .name   = "adm5120-hcd",
815                .owner  = THIS_MODULE,
816        },
817};
818
819static int __init adm5120hcd_init(void)
820{
821        if (usb_disabled())
822                return -ENODEV;
823        if (!adm5120_board.has_usb)
824                return -ENODEV;
825
826        return platform_driver_register(&adm5120hcd_driver);
827}
828
829static void __exit adm5120hcd_exit(void)
830{
831        platform_driver_unregister(&adm5120hcd_driver);
832}
833
834module_init(adm5120hcd_init);
835module_exit(adm5120hcd_exit);
Note: See TracBrowser for help on using the repository browser.