blob: 8bb2275c09473a6e9a8e15486ea44e9849d05633 [file] [log] [blame]
wdenk149dded2003-09-10 18:20:28 +00001/*
2 * URB OHCI HCD (Host Controller Driver) for USB on the S3C2400.
3 *
4 * (C) Copyright 2003
Detlev Zundel792a09e2009-05-13 10:54:10 +02005 * Gary Jennejohn, DENX Software Engineering <garyj@denx.de>
wdenk149dded2003-09-10 18:20:28 +00006 *
wdenk9d46ea42005-03-14 23:56:42 +00007 * Note: Much of this code has been derived from Linux 2.4
8 * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
9 * (C) Copyright 2000-2002 David Brownell
10 *
Wolfgang Denk1a459662013-07-08 09:37:19 +020011 * SPDX-License-Identifier: GPL-2.0+
wdenk149dded2003-09-10 18:20:28 +000012 */
13/*
14 * IMPORTANT NOTES
Mike Frysingerc7d703f2009-01-01 18:27:27 -050015 * 1 - this driver is intended for use with USB Mass Storage Devices
wdenk149dded2003-09-10 18:20:28 +000016 * (BBB) ONLY. There is NO support for Interrupt or Isochronous pipes!
17 */
18
19#include <common.h>
wdenka2663ea2003-12-07 18:32:37 +000020/* #include <pci.h> no PCI on the S3C24X0 */
wdenk149dded2003-09-10 18:20:28 +000021
kevin.morfitt@fearnside-systems.co.ukac678042009-11-17 18:30:34 +090022#if defined(CONFIG_USB_OHCI) && defined(CONFIG_S3C24X0)
wdenk149dded2003-09-10 18:20:28 +000023
kevin.morfitt@fearnside-systems.co.ukac678042009-11-17 18:30:34 +090024#include <asm/arch/s3c24x0_cpu.h>
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +090025#include <asm/io.h>
wdenk149dded2003-09-10 18:20:28 +000026#include <malloc.h>
27#include <usb.h>
Marek Vasutfb24ffc2012-07-21 05:02:22 +000028#include "ohci-s3c24xx.h"
wdenk149dded2003-09-10 18:20:28 +000029
30#define OHCI_USE_NPS /* force NoPowerSwitching mode */
31#undef OHCI_VERBOSE_DEBUG /* not always helpful */
32
33
34/* For initializing controller (mask in an HCFS mode too) */
35#define OHCI_CONTROL_INIT \
36 (OHCI_CTRL_CBSR & 0x3) | OHCI_CTRL_IE | OHCI_CTRL_PLE
37
wdenk149dded2003-09-10 18:20:28 +000038#undef DEBUG
39#ifdef DEBUG
40#define dbg(format, arg...) printf("DEBUG: " format "\n", ## arg)
41#else
42#define dbg(format, arg...) do {} while(0)
43#endif /* DEBUG */
44#define err(format, arg...) printf("ERROR: " format "\n", ## arg)
45#undef SHOW_INFO
46#ifdef SHOW_INFO
47#define info(format, arg...) printf("INFO: " format "\n", ## arg)
48#else
49#define info(format, arg...) do {} while(0)
50#endif
51
52#define m16_swap(x) swap_16(x)
53#define m32_swap(x) swap_32(x)
54
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +090055/* global struct ohci */
56static struct ohci gohci;
wdenk149dded2003-09-10 18:20:28 +000057/* this must be aligned to a 256 byte boundary */
58struct ohci_hcca ghcca[1];
59/* a pointer to the aligned storage */
60struct ohci_hcca *phcca;
61/* this allocates EDs for all possible endpoints */
62struct ohci_device ohci_dev;
63/* urb_priv */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +090064struct urb_priv urb_priv;
dzu8a42eac2003-09-29 21:55:54 +000065/* RHSC flag */
66int got_rhsc;
67/* device which was disconnected */
68struct usb_device *devgone;
Wolfgang Denk9c998aa2005-07-21 11:57:57 +020069/* flag guarding URB transation */
70int urb_finished = 0;
wdenk149dded2003-09-10 18:20:28 +000071
72/*-------------------------------------------------------------------------*/
73
74/* AMD-756 (D2 rev) reports corrupt register contents in some cases.
75 * The erratum (#4) description is incorrect. AMD's workaround waits
76 * till some bits (mostly reserved) are clear; ok for all revs.
77 */
78#define OHCI_QUIRK_AMD756 0xabcd
79#define read_roothub(hc, register, mask) ({ \
80 u32 temp = readl (&hc->regs->roothub.register); \
81 if (hc->flags & OHCI_QUIRK_AMD756) \
82 while (temp & mask) \
83 temp = readl (&hc->regs->roothub.register); \
84 temp; })
85
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +090086static u32 roothub_a(struct ohci *hc)
87{
88 return read_roothub(hc, a, 0xfc0fe000);
89}
90static inline u32 roothub_b(struct ohci *hc)
91{
92 return readl(&hc->regs->roothub.b);
93}
94static inline u32 roothub_status(struct ohci *hc)
95{
96 return readl(&hc->regs->roothub.status);
97}
98static u32 roothub_portstatus(struct ohci *hc, int i)
99{
100 return read_roothub(hc, portstatus[i], 0xffe0fce0);
101}
wdenk149dded2003-09-10 18:20:28 +0000102
103/* forward declaration */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900104static int hc_interrupt(void);
105static void td_submit_job(struct usb_device *dev, unsigned long pipe,
106 void *buffer, int transfer_len,
107 struct devrequest *setup, struct urb_priv *urb,
108 int interval);
wdenk149dded2003-09-10 18:20:28 +0000109
110/*-------------------------------------------------------------------------*
111 * URB support functions
112 *-------------------------------------------------------------------------*/
113
114/* free HCD-private data associated with this URB */
115
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900116static void urb_free_priv(struct urb_priv *urb)
wdenk149dded2003-09-10 18:20:28 +0000117{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900118 int i;
119 int last;
120 struct td *td;
wdenk149dded2003-09-10 18:20:28 +0000121
122 last = urb->length - 1;
123 if (last >= 0) {
124 for (i = 0; i <= last; i++) {
125 td = urb->td[i];
126 if (td) {
127 td->usb_dev = NULL;
128 urb->td[i] = NULL;
129 }
130 }
131 }
132}
133
134/*-------------------------------------------------------------------------*/
135
136#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900137static int sohci_get_current_frame_number(struct usb_device *dev);
wdenk149dded2003-09-10 18:20:28 +0000138
139/* debug| print the main components of an URB
140 * small: 0) header + data packets 1) just header */
141
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900142static void pkt_print(struct usb_device *dev, unsigned long pipe, void *buffer,
143 int transfer_len, struct devrequest *setup, char *str,
144 int small)
wdenk149dded2003-09-10 18:20:28 +0000145{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900146 struct urb_priv *purb = &urb_priv;
wdenk149dded2003-09-10 18:20:28 +0000147
148 dbg("%s URB:[%4x] dev:%2d,ep:%2d-%c,type:%s,len:%d/%d stat:%#lx",
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900149 str,
150 sohci_get_current_frame_number(dev),
151 usb_pipedevice(pipe),
152 usb_pipeendpoint(pipe),
153 usb_pipeout(pipe) ? 'O' : 'I',
154 usb_pipetype(pipe) < 2 ?
155 (usb_pipeint(pipe) ? "INTR" : "ISOC") :
156 (usb_pipecontrol(pipe) ? "CTRL" : "BULK"),
157 purb->actual_length, transfer_len, dev->status);
wdenk149dded2003-09-10 18:20:28 +0000158#ifdef OHCI_VERBOSE_DEBUG
159 if (!small) {
160 int i, len;
161
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900162 if (usb_pipecontrol(pipe)) {
163 printf(__FILE__ ": cmd(8):");
164 for (i = 0; i < 8; i++)
165 printf(" %02x", ((__u8 *) setup)[i]);
166 printf("\n");
wdenk149dded2003-09-10 18:20:28 +0000167 }
168 if (transfer_len > 0 && buffer) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900169 printf(__FILE__ ": data(%d/%d):",
170 purb->actual_length, transfer_len);
171 len = usb_pipeout(pipe) ?
172 transfer_len : purb->actual_length;
wdenk149dded2003-09-10 18:20:28 +0000173 for (i = 0; i < 16 && i < len; i++)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900174 printf(" %02x", ((__u8 *) buffer)[i]);
175 printf("%s\n", i < len ? "..." : "");
wdenk149dded2003-09-10 18:20:28 +0000176 }
177 }
178#endif
179}
180
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900181/* just for debugging; prints non-empty branches of the
182 int ed tree inclusive iso eds*/
183void ep_print_int_eds(struct ohci *ohci, char *str)
184{
wdenk149dded2003-09-10 18:20:28 +0000185 int i, j;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900186 __u32 *ed_p;
187 for (i = 0; i < 32; i++) {
wdenk149dded2003-09-10 18:20:28 +0000188 j = 5;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900189 ed_p = &(ohci->hcca->int_table[i]);
wdenk149dded2003-09-10 18:20:28 +0000190 if (*ed_p == 0)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900191 continue;
192 printf(__FILE__ ": %s branch int %2d(%2x):", str, i, i);
wdenk149dded2003-09-10 18:20:28 +0000193 while (*ed_p != 0 && j--) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900194 struct ed *ed = (struct ed *) m32_swap(ed_p);
195 printf(" ed: %4x;", ed->hwINFO);
wdenk149dded2003-09-10 18:20:28 +0000196 ed_p = &ed->hwNextED;
197 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900198 printf("\n");
wdenk149dded2003-09-10 18:20:28 +0000199 }
200}
201
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900202static void ohci_dump_intr_mask(char *label, __u32 mask)
wdenk149dded2003-09-10 18:20:28 +0000203{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900204 dbg("%s: 0x%08x%s%s%s%s%s%s%s%s%s",
205 label,
206 mask,
207 (mask & OHCI_INTR_MIE) ? " MIE" : "",
208 (mask & OHCI_INTR_OC) ? " OC" : "",
209 (mask & OHCI_INTR_RHSC) ? " RHSC" : "",
210 (mask & OHCI_INTR_FNO) ? " FNO" : "",
211 (mask & OHCI_INTR_UE) ? " UE" : "",
212 (mask & OHCI_INTR_RD) ? " RD" : "",
213 (mask & OHCI_INTR_SF) ? " SF" : "",
214 (mask & OHCI_INTR_WDH) ? " WDH" : "",
215 (mask & OHCI_INTR_SO) ? " SO" : "");
wdenk149dded2003-09-10 18:20:28 +0000216}
217
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900218static void maybe_print_eds(char *label, __u32 value)
wdenk149dded2003-09-10 18:20:28 +0000219{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900220 struct ed *edp = (struct ed *) value;
wdenk149dded2003-09-10 18:20:28 +0000221
222 if (value) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900223 dbg("%s %08x", label, value);
224 dbg("%08x", edp->hwINFO);
225 dbg("%08x", edp->hwTailP);
226 dbg("%08x", edp->hwHeadP);
227 dbg("%08x", edp->hwNextED);
wdenk149dded2003-09-10 18:20:28 +0000228 }
229}
230
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900231static char *hcfs2string(int state)
wdenk149dded2003-09-10 18:20:28 +0000232{
233 switch (state) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900234 case OHCI_USB_RESET:
235 return "reset";
236 case OHCI_USB_RESUME:
237 return "resume";
238 case OHCI_USB_OPER:
239 return "operational";
240 case OHCI_USB_SUSPEND:
241 return "suspend";
wdenk149dded2003-09-10 18:20:28 +0000242 }
243 return "?";
244}
245
246/* dump control and status registers */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900247static void ohci_dump_status(struct ohci *controller)
wdenk149dded2003-09-10 18:20:28 +0000248{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900249 struct ohci_regs *regs = controller->regs;
250 __u32 temp;
wdenk149dded2003-09-10 18:20:28 +0000251
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900252 temp = readl(&regs->revision) & 0xff;
wdenk149dded2003-09-10 18:20:28 +0000253 if (temp != 0x10)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900254 dbg("spec %d.%d", (temp >> 4), (temp & 0x0f));
wdenk149dded2003-09-10 18:20:28 +0000255
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900256 temp = readl(&regs->control);
257 dbg("control: 0x%08x%s%s%s HCFS=%s%s%s%s%s CBSR=%d", temp,
258 (temp & OHCI_CTRL_RWE) ? " RWE" : "",
259 (temp & OHCI_CTRL_RWC) ? " RWC" : "",
260 (temp & OHCI_CTRL_IR) ? " IR" : "",
261 hcfs2string(temp & OHCI_CTRL_HCFS),
262 (temp & OHCI_CTRL_BLE) ? " BLE" : "",
263 (temp & OHCI_CTRL_CLE) ? " CLE" : "",
264 (temp & OHCI_CTRL_IE) ? " IE" : "",
265 (temp & OHCI_CTRL_PLE) ? " PLE" : "", temp & OHCI_CTRL_CBSR);
wdenk149dded2003-09-10 18:20:28 +0000266
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900267 temp = readl(&regs->cmdstatus);
268 dbg("cmdstatus: 0x%08x SOC=%d%s%s%s%s", temp,
269 (temp & OHCI_SOC) >> 16,
270 (temp & OHCI_OCR) ? " OCR" : "",
271 (temp & OHCI_BLF) ? " BLF" : "",
272 (temp & OHCI_CLF) ? " CLF" : "", (temp & OHCI_HCR) ? " HCR" : "");
wdenk149dded2003-09-10 18:20:28 +0000273
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900274 ohci_dump_intr_mask("intrstatus", readl(&regs->intrstatus));
275 ohci_dump_intr_mask("intrenable", readl(&regs->intrenable));
wdenk149dded2003-09-10 18:20:28 +0000276
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900277 maybe_print_eds("ed_periodcurrent", readl(&regs->ed_periodcurrent));
wdenk149dded2003-09-10 18:20:28 +0000278
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900279 maybe_print_eds("ed_controlhead", readl(&regs->ed_controlhead));
280 maybe_print_eds("ed_controlcurrent", readl(&regs->ed_controlcurrent));
wdenk149dded2003-09-10 18:20:28 +0000281
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900282 maybe_print_eds("ed_bulkhead", readl(&regs->ed_bulkhead));
283 maybe_print_eds("ed_bulkcurrent", readl(&regs->ed_bulkcurrent));
wdenk149dded2003-09-10 18:20:28 +0000284
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900285 maybe_print_eds("donehead", readl(&regs->donehead));
wdenk149dded2003-09-10 18:20:28 +0000286}
287
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900288static void ohci_dump_roothub(struct ohci *controller, int verbose)
wdenk149dded2003-09-10 18:20:28 +0000289{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900290 __u32 temp, ndp, i;
wdenk149dded2003-09-10 18:20:28 +0000291
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900292 temp = roothub_a(controller);
wdenk149dded2003-09-10 18:20:28 +0000293 ndp = (temp & RH_A_NDP);
294
295 if (verbose) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900296 dbg("roothub.a: %08x POTPGT=%d%s%s%s%s%s NDP=%d", temp,
297 ((temp & RH_A_POTPGT) >> 24) & 0xff,
298 (temp & RH_A_NOCP) ? " NOCP" : "",
299 (temp & RH_A_OCPM) ? " OCPM" : "",
300 (temp & RH_A_DT) ? " DT" : "",
301 (temp & RH_A_NPS) ? " NPS" : "",
302 (temp & RH_A_PSM) ? " PSM" : "", ndp);
303 temp = roothub_b(controller);
304 dbg("roothub.b: %08x PPCM=%04x DR=%04x",
305 temp, (temp & RH_B_PPCM) >> 16, (temp & RH_B_DR)
306 );
307 temp = roothub_status(controller);
308 dbg("roothub.status: %08x%s%s%s%s%s%s",
309 temp,
310 (temp & RH_HS_CRWE) ? " CRWE" : "",
311 (temp & RH_HS_OCIC) ? " OCIC" : "",
312 (temp & RH_HS_LPSC) ? " LPSC" : "",
313 (temp & RH_HS_DRWE) ? " DRWE" : "",
314 (temp & RH_HS_OCI) ? " OCI" : "",
315 (temp & RH_HS_LPS) ? " LPS" : "");
wdenk149dded2003-09-10 18:20:28 +0000316 }
317
318 for (i = 0; i < ndp; i++) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900319 temp = roothub_portstatus(controller, i);
320 dbg("roothub.portstatus [%d] = 0x%08x%s%s%s%s%s%s%s%s%s%s%s%s",
321 i,
322 temp,
323 (temp & RH_PS_PRSC) ? " PRSC" : "",
324 (temp & RH_PS_OCIC) ? " OCIC" : "",
325 (temp & RH_PS_PSSC) ? " PSSC" : "",
326 (temp & RH_PS_PESC) ? " PESC" : "",
327 (temp & RH_PS_CSC) ? " CSC" : "",
328 (temp & RH_PS_LSDA) ? " LSDA" : "",
329 (temp & RH_PS_PPS) ? " PPS" : "",
330 (temp & RH_PS_PRS) ? " PRS" : "",
331 (temp & RH_PS_POCI) ? " POCI" : "",
332 (temp & RH_PS_PSS) ? " PSS" : "",
333 (temp & RH_PS_PES) ? " PES" : "",
334 (temp & RH_PS_CCS) ? " CCS" : "");
wdenk149dded2003-09-10 18:20:28 +0000335 }
336}
337
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900338static void ohci_dump(struct ohci *controller, int verbose)
wdenk149dded2003-09-10 18:20:28 +0000339{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900340 dbg("OHCI controller usb-%s state", controller->slot_name);
wdenk149dded2003-09-10 18:20:28 +0000341
342 /* dumps some of the state we know about */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900343 ohci_dump_status(controller);
wdenk149dded2003-09-10 18:20:28 +0000344 if (verbose)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900345 ep_print_int_eds(controller, "hcca");
346 dbg("hcca frame #%04x", controller->hcca->frame_no);
347 ohci_dump_roothub(controller, 1);
wdenk149dded2003-09-10 18:20:28 +0000348}
349
wdenk149dded2003-09-10 18:20:28 +0000350#endif /* DEBUG */
351
352/*-------------------------------------------------------------------------*
353 * Interface functions (URB)
354 *-------------------------------------------------------------------------*/
355
356/* get a transfer request */
357
358int sohci_submit_job(struct usb_device *dev, unsigned long pipe, void *buffer,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900359 int transfer_len, struct devrequest *setup, int interval)
wdenk149dded2003-09-10 18:20:28 +0000360{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900361 struct ohci *ohci;
362 struct ed *ed;
363 struct urb_priv *purb_priv;
wdenk149dded2003-09-10 18:20:28 +0000364 int i, size = 0;
365
366 ohci = &gohci;
367
368 /* when controller's hung, permit only roothub cleanup attempts
369 * such as powering down ports */
370 if (ohci->disabled) {
371 err("sohci_submit_job: EPIPE");
372 return -1;
373 }
374
Wolfgang Denk9c998aa2005-07-21 11:57:57 +0200375 /* if we have an unfinished URB from previous transaction let's
376 * fail and scream as quickly as possible so as not to corrupt
377 * further communication */
378 if (!urb_finished) {
379 err("sohci_submit_job: URB NOT FINISHED");
380 return -1;
381 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900382 /* we're about to begin a new transaction here
383 so mark the URB unfinished */
Wolfgang Denk9c998aa2005-07-21 11:57:57 +0200384 urb_finished = 0;
385
wdenk149dded2003-09-10 18:20:28 +0000386 /* every endpoint has a ed, locate and fill it */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900387 ed = ep_add_ed(dev, pipe);
388 if (!ed) {
wdenk149dded2003-09-10 18:20:28 +0000389 err("sohci_submit_job: ENOMEM");
390 return -1;
391 }
392
393 /* for the private part of the URB we need the number of TDs (size) */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900394 switch (usb_pipetype(pipe)) {
395 case PIPE_BULK:
396 /* one TD for every 4096 Byte */
397 size = (transfer_len - 1) / 4096 + 1;
398 break;
399 case PIPE_CONTROL:
400 /* 1 TD for setup, 1 for ACK and 1 for every 4096 B */
401 size = (transfer_len == 0) ? 2 : (transfer_len - 1) / 4096 + 3;
402 break;
wdenk149dded2003-09-10 18:20:28 +0000403 }
404
405 if (size >= (N_URB_TD - 1)) {
406 err("need %d TDs, only have %d", size, N_URB_TD);
407 return -1;
408 }
409 purb_priv = &urb_priv;
410 purb_priv->pipe = pipe;
411
412 /* fill the private part of the URB */
413 purb_priv->length = size;
414 purb_priv->ed = ed;
415 purb_priv->actual_length = 0;
416
417 /* allocate the TDs */
418 /* note that td[0] was allocated in ep_add_ed */
419 for (i = 0; i < size; i++) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900420 purb_priv->td[i] = td_alloc(dev);
wdenk149dded2003-09-10 18:20:28 +0000421 if (!purb_priv->td[i]) {
422 purb_priv->length = i;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900423 urb_free_priv(purb_priv);
wdenk149dded2003-09-10 18:20:28 +0000424 err("sohci_submit_job: ENOMEM");
425 return -1;
426 }
427 }
428
429 if (ed->state == ED_NEW || (ed->state & ED_DEL)) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900430 urb_free_priv(purb_priv);
wdenk149dded2003-09-10 18:20:28 +0000431 err("sohci_submit_job: EINVAL");
432 return -1;
433 }
434
435 /* link the ed into a chain if is not already */
436 if (ed->state != ED_OPER)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900437 ep_link(ohci, ed);
wdenk149dded2003-09-10 18:20:28 +0000438
439 /* fill the TDs and link it to the ed */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900440 td_submit_job(dev, pipe, buffer, transfer_len, setup, purb_priv,
441 interval);
wdenk149dded2003-09-10 18:20:28 +0000442
443 return 0;
444}
445
446/*-------------------------------------------------------------------------*/
447
448#ifdef DEBUG
449/* tell us the current USB frame number */
450
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900451static int sohci_get_current_frame_number(struct usb_device *usb_dev)
wdenk149dded2003-09-10 18:20:28 +0000452{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900453 struct ohci *ohci = &gohci;
wdenk149dded2003-09-10 18:20:28 +0000454
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900455 return m16_swap(ohci->hcca->frame_no);
wdenk149dded2003-09-10 18:20:28 +0000456}
457#endif
458
459/*-------------------------------------------------------------------------*
460 * ED handling functions
461 *-------------------------------------------------------------------------*/
462
463/* link an ed into one of the HC chains */
464
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900465static int ep_link(struct ohci *ohci, struct ed *edi)
wdenk149dded2003-09-10 18:20:28 +0000466{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900467 struct ed *ed = edi;
wdenk149dded2003-09-10 18:20:28 +0000468
469 ed->state = ED_OPER;
470
471 switch (ed->type) {
472 case PIPE_CONTROL:
473 ed->hwNextED = 0;
474 if (ohci->ed_controltail == NULL) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900475 writel((u32)ed, &ohci->regs->ed_controlhead);
wdenk149dded2003-09-10 18:20:28 +0000476 } else {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900477 ohci->ed_controltail->hwNextED = (__u32) m32_swap(ed);
wdenk149dded2003-09-10 18:20:28 +0000478 }
479 ed->ed_prev = ohci->ed_controltail;
480 if (!ohci->ed_controltail && !ohci->ed_rm_list[0] &&
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900481 !ohci->ed_rm_list[1] && !ohci->sleeping) {
wdenk149dded2003-09-10 18:20:28 +0000482 ohci->hc_control |= OHCI_CTRL_CLE;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900483 writel(ohci->hc_control, &ohci->regs->control);
wdenk149dded2003-09-10 18:20:28 +0000484 }
485 ohci->ed_controltail = edi;
486 break;
487
488 case PIPE_BULK:
489 ed->hwNextED = 0;
490 if (ohci->ed_bulktail == NULL) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900491 writel((u32)ed, &ohci->regs->ed_bulkhead);
wdenk149dded2003-09-10 18:20:28 +0000492 } else {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900493 ohci->ed_bulktail->hwNextED = (__u32) m32_swap(ed);
wdenk149dded2003-09-10 18:20:28 +0000494 }
495 ed->ed_prev = ohci->ed_bulktail;
496 if (!ohci->ed_bulktail && !ohci->ed_rm_list[0] &&
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900497 !ohci->ed_rm_list[1] && !ohci->sleeping) {
wdenk149dded2003-09-10 18:20:28 +0000498 ohci->hc_control |= OHCI_CTRL_BLE;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900499 writel(ohci->hc_control, &ohci->regs->control);
wdenk149dded2003-09-10 18:20:28 +0000500 }
501 ohci->ed_bulktail = edi;
502 break;
503 }
504 return 0;
505}
506
507/*-------------------------------------------------------------------------*/
508
509/* unlink an ed from one of the HC chains.
510 * just the link to the ed is unlinked.
511 * the link from the ed still points to another operational ed or 0
512 * so the HC can eventually finish the processing of the unlinked ed */
513
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900514static int ep_unlink(struct ohci *ohci, struct ed *ed)
wdenk149dded2003-09-10 18:20:28 +0000515{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900516 struct ed *next;
517 ed->hwINFO |= m32_swap(OHCI_ED_SKIP);
wdenk149dded2003-09-10 18:20:28 +0000518
519 switch (ed->type) {
520 case PIPE_CONTROL:
521 if (ed->ed_prev == NULL) {
522 if (!ed->hwNextED) {
523 ohci->hc_control &= ~OHCI_CTRL_CLE;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900524 writel(ohci->hc_control, &ohci->regs->control);
wdenk149dded2003-09-10 18:20:28 +0000525 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900526 writel(m32_swap(*((__u32 *) &ed->hwNextED)),
527 &ohci->regs->ed_controlhead);
wdenk149dded2003-09-10 18:20:28 +0000528 } else {
529 ed->ed_prev->hwNextED = ed->hwNextED;
530 }
531 if (ohci->ed_controltail == ed) {
532 ohci->ed_controltail = ed->ed_prev;
533 } else {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900534 next = (struct ed *)m32_swap(*((__u32 *)&ed->hwNextED));
535 next->ed_prev = ed->ed_prev;
wdenk149dded2003-09-10 18:20:28 +0000536 }
537 break;
538
539 case PIPE_BULK:
540 if (ed->ed_prev == NULL) {
541 if (!ed->hwNextED) {
542 ohci->hc_control &= ~OHCI_CTRL_BLE;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900543 writel(ohci->hc_control, &ohci->regs->control);
wdenk149dded2003-09-10 18:20:28 +0000544 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900545 writel(m32_swap(*((__u32 *) &ed->hwNextED)),
546 &ohci->regs->ed_bulkhead);
wdenk149dded2003-09-10 18:20:28 +0000547 } else {
548 ed->ed_prev->hwNextED = ed->hwNextED;
549 }
550 if (ohci->ed_bulktail == ed) {
551 ohci->ed_bulktail = ed->ed_prev;
552 } else {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900553 next = (struct ed *)m32_swap(*((__u32 *)&ed->hwNextED));
554 next->ed_prev = ed->ed_prev;
wdenk149dded2003-09-10 18:20:28 +0000555 }
556 break;
557 }
558 ed->state = ED_UNLINK;
559 return 0;
560}
561
wdenk149dded2003-09-10 18:20:28 +0000562/*-------------------------------------------------------------------------*/
563
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900564/* add/reinit an endpoint; this should be done once at the usb_set_configuration
565 * command, but the USB stack is a little bit stateless so we do it at every
566 * transaction. If the state of the ed is ED_NEW then a dummy td is added and
567 * the state is changed to ED_UNLINK. In all other cases the state is left
568 * unchanged. The ed info fields are setted anyway even though most of them
569 * should not change */
wdenk149dded2003-09-10 18:20:28 +0000570
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900571static struct ed *ep_add_ed(struct usb_device *usb_dev, unsigned long pipe)
wdenk149dded2003-09-10 18:20:28 +0000572{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900573 struct td *td;
574 struct ed *ed_ret;
575 struct ed *ed;
wdenk149dded2003-09-10 18:20:28 +0000576
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900577 ed = ed_ret = &ohci_dev.ed[(usb_pipeendpoint(pipe) << 1) |
578 (usb_pipecontrol(pipe) ? 0 :
579 usb_pipeout(pipe))];
wdenk149dded2003-09-10 18:20:28 +0000580
581 if ((ed->state & ED_DEL) || (ed->state & ED_URB_DEL)) {
582 err("ep_add_ed: pending delete");
583 /* pending delete request */
584 return NULL;
585 }
586
587 if (ed->state == ED_NEW) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900588 ed->hwINFO = m32_swap(OHCI_ED_SKIP); /* skip ed */
wdenk42d1f032003-10-15 23:53:47 +0000589 /* dummy td; end of td list for ed */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900590 td = td_alloc(usb_dev);
591 ed->hwTailP = (__u32) m32_swap(td);
wdenk149dded2003-09-10 18:20:28 +0000592 ed->hwHeadP = ed->hwTailP;
593 ed->state = ED_UNLINK;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900594 ed->type = usb_pipetype(pipe);
wdenk149dded2003-09-10 18:20:28 +0000595 ohci_dev.ed_cnt++;
596 }
597
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900598 ed->hwINFO = m32_swap(usb_pipedevice(pipe)
599 | usb_pipeendpoint(pipe) << 7
600 | (usb_pipeisoc(pipe) ? 0x8000 : 0)
601 | (usb_pipecontrol(pipe) ? 0 :
602 (usb_pipeout(pipe) ? 0x800 : 0x1000))
Ilya Yanokc60795f2012-11-06 13:48:20 +0000603 | (usb_dev->speed == USB_SPEED_LOW) << 13 |
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900604 usb_maxpacket(usb_dev, pipe) << 16);
wdenk149dded2003-09-10 18:20:28 +0000605
606 return ed_ret;
607}
608
609/*-------------------------------------------------------------------------*
610 * TD handling functions
611 *-------------------------------------------------------------------------*/
612
613/* enqueue next TD for this URB (OHCI spec 5.2.8.2) */
614
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900615static void td_fill(struct ohci *ohci, unsigned int info, void *data, int len,
616 struct usb_device *dev, int index,
617 struct urb_priv *urb_priv)
wdenk149dded2003-09-10 18:20:28 +0000618{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900619 struct td *td, *td_pt;
wdenk149dded2003-09-10 18:20:28 +0000620#ifdef OHCI_FILL_TRACE
621 int i;
622#endif
623
624 if (index > urb_priv->length) {
625 err("index > length");
626 return;
627 }
628 /* use this td as the next dummy */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900629 td_pt = urb_priv->td[index];
wdenk149dded2003-09-10 18:20:28 +0000630 td_pt->hwNextTD = 0;
631
632 /* fill the old dummy TD */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900633 td = urb_priv->td[index] =
634 (struct td *) (m32_swap(urb_priv->ed->hwTailP) & ~0xf);
wdenk149dded2003-09-10 18:20:28 +0000635
636 td->ed = urb_priv->ed;
637 td->next_dl_td = NULL;
638 td->index = index;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900639 td->data = (__u32) data;
wdenk149dded2003-09-10 18:20:28 +0000640#ifdef OHCI_FILL_TRACE
Remy Bohmer9dbc3662008-10-10 10:23:22 +0200641 if (usb_pipebulk(urb_priv->pipe) && usb_pipeout(urb_priv->pipe)) {
wdenk149dded2003-09-10 18:20:28 +0000642 for (i = 0; i < len; i++)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900643 printf("td->data[%d] %#2x ", i,
644 ((unsigned char *)td->data)[i]);
wdenk149dded2003-09-10 18:20:28 +0000645 printf("\n");
646 }
647#endif
648 if (!len)
649 data = 0;
650
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900651 td->hwINFO = (__u32) m32_swap(info);
652 td->hwCBP = (__u32) m32_swap(data);
wdenk149dded2003-09-10 18:20:28 +0000653 if (data)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900654 td->hwBE = (__u32) m32_swap(data + len - 1);
wdenk149dded2003-09-10 18:20:28 +0000655 else
656 td->hwBE = 0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900657 td->hwNextTD = (__u32) m32_swap(td_pt);
wdenk149dded2003-09-10 18:20:28 +0000658
659 /* append to queue */
660 td->ed->hwTailP = td->hwNextTD;
661}
662
663/*-------------------------------------------------------------------------*/
664
665/* prepare all TDs of a transfer */
666
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900667static void td_submit_job(struct usb_device *dev, unsigned long pipe,
668 void *buffer, int transfer_len,
669 struct devrequest *setup, struct urb_priv *urb,
670 int interval)
wdenk149dded2003-09-10 18:20:28 +0000671{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900672 struct ohci *ohci = &gohci;
wdenk149dded2003-09-10 18:20:28 +0000673 int data_len = transfer_len;
674 void *data;
675 int cnt = 0;
676 __u32 info = 0;
wdenk42d1f032003-10-15 23:53:47 +0000677 unsigned int toggle = 0;
wdenk149dded2003-09-10 18:20:28 +0000678
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900679 /* OHCI handles the DATA-toggles itself, we just
680 use the USB-toggle bits for reseting */
681 if (usb_gettoggle(dev, usb_pipeendpoint(pipe), usb_pipeout(pipe))) {
wdenk42d1f032003-10-15 23:53:47 +0000682 toggle = TD_T_TOGGLE;
wdenk149dded2003-09-10 18:20:28 +0000683 } else {
wdenk42d1f032003-10-15 23:53:47 +0000684 toggle = TD_T_DATA0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900685 usb_settoggle(dev, usb_pipeendpoint(pipe), usb_pipeout(pipe),
686 1);
wdenk149dded2003-09-10 18:20:28 +0000687 }
688 urb->td_cnt = 0;
689 if (data_len)
690 data = buffer;
691 else
692 data = 0;
693
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900694 switch (usb_pipetype(pipe)) {
wdenk149dded2003-09-10 18:20:28 +0000695 case PIPE_BULK:
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900696 info = usb_pipeout(pipe) ? TD_CC | TD_DP_OUT : TD_CC | TD_DP_IN;
697 while (data_len > 4096) {
698 td_fill(ohci, info | (cnt ? TD_T_TOGGLE : toggle), data,
699 4096, dev, cnt, urb);
700 data += 4096;
701 data_len -= 4096;
702 cnt++;
wdenk149dded2003-09-10 18:20:28 +0000703 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900704 info = usb_pipeout(pipe) ?
705 TD_CC | TD_DP_OUT :
706 TD_CC | TD_R | TD_DP_IN;
707 td_fill(ohci, info | (cnt ? TD_T_TOGGLE : toggle), data,
708 data_len, dev, cnt, urb);
wdenk149dded2003-09-10 18:20:28 +0000709 cnt++;
710
711 if (!ohci->sleeping)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900712 /* start bulk list */
713 writel(OHCI_BLF, &ohci->regs->cmdstatus);
wdenk149dded2003-09-10 18:20:28 +0000714 break;
715
716 case PIPE_CONTROL:
717 info = TD_CC | TD_DP_SETUP | TD_T_DATA0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900718 td_fill(ohci, info, setup, 8, dev, cnt++, urb);
wdenk149dded2003-09-10 18:20:28 +0000719 if (data_len > 0) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900720 info = usb_pipeout(pipe) ?
721 TD_CC | TD_R | TD_DP_OUT | TD_T_DATA1 :
722 TD_CC | TD_R | TD_DP_IN | TD_T_DATA1;
wdenk149dded2003-09-10 18:20:28 +0000723 /* NOTE: mishandles transfers >8K, some >4K */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900724 td_fill(ohci, info, data, data_len, dev, cnt++, urb);
wdenk149dded2003-09-10 18:20:28 +0000725 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900726 info = usb_pipeout(pipe) ?
727 TD_CC | TD_DP_IN | TD_T_DATA1 :
728 TD_CC | TD_DP_OUT | TD_T_DATA1;
729 td_fill(ohci, info, data, 0, dev, cnt++, urb);
wdenk149dded2003-09-10 18:20:28 +0000730 if (!ohci->sleeping)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900731 /* start Control list */
732 writel(OHCI_CLF, &ohci->regs->cmdstatus);
wdenk149dded2003-09-10 18:20:28 +0000733 break;
734 }
735 if (urb->length != cnt)
736 dbg("TD LENGTH %d != CNT %d", urb->length, cnt);
737}
738
739/*-------------------------------------------------------------------------*
740 * Done List handling functions
741 *-------------------------------------------------------------------------*/
742
743
744/* calculate the transfer length and update the urb */
745
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900746static void dl_transfer_length(struct td *td)
wdenk149dded2003-09-10 18:20:28 +0000747{
Wolfgang Denk0841ca92011-10-06 09:22:52 +0200748 __u32 tdBE, tdCBP;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900749 struct urb_priv *lurb_priv = &urb_priv;
wdenk149dded2003-09-10 18:20:28 +0000750
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900751 tdBE = m32_swap(td->hwBE);
752 tdCBP = m32_swap(td->hwCBP);
wdenk149dded2003-09-10 18:20:28 +0000753
Remy Bohmer9dbc3662008-10-10 10:23:22 +0200754 if (!(usb_pipecontrol(lurb_priv->pipe) &&
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900755 ((td->index == 0) || (td->index == lurb_priv->length - 1)))) {
wdenk149dded2003-09-10 18:20:28 +0000756 if (tdBE != 0) {
757 if (td->hwCBP == 0)
758 lurb_priv->actual_length += tdBE - td->data + 1;
759 else
760 lurb_priv->actual_length += tdCBP - td->data;
761 }
762 }
763}
764
765/*-------------------------------------------------------------------------*/
766
767/* replies to the request have to be on a FIFO basis so
768 * we reverse the reversed done-list */
769
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900770static struct td *dl_reverse_done_list(struct ohci *ohci)
wdenk149dded2003-09-10 18:20:28 +0000771{
772 __u32 td_list_hc;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900773 __u32 tmp;
774 struct td *td_rev = NULL;
775 struct td *td_list = NULL;
776 struct urb_priv *lurb_priv = NULL;
wdenk149dded2003-09-10 18:20:28 +0000777
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900778 td_list_hc = m32_swap(ohci->hcca->done_head) & 0xfffffff0;
wdenk149dded2003-09-10 18:20:28 +0000779 ohci->hcca->done_head = 0;
780
781 while (td_list_hc) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900782 td_list = (struct td *) td_list_hc;
wdenk149dded2003-09-10 18:20:28 +0000783
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900784 if (TD_CC_GET(m32_swap(td_list->hwINFO))) {
wdenk149dded2003-09-10 18:20:28 +0000785 lurb_priv = &urb_priv;
786 dbg(" USB-error/status: %x : %p",
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900787 TD_CC_GET(m32_swap(td_list->hwINFO)), td_list);
788 if (td_list->ed->hwHeadP & m32_swap(0x1)) {
789 if (lurb_priv &&
790 ((td_list->index+1) < lurb_priv->length)) {
791 tmp = lurb_priv->length - 1;
wdenk149dded2003-09-10 18:20:28 +0000792 td_list->ed->hwHeadP =
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900793 (lurb_priv->td[tmp]->hwNextTD &
794 m32_swap(0xfffffff0)) |
795 (td_list->ed->hwHeadP &
796 m32_swap(0x2));
797 lurb_priv->td_cnt += lurb_priv->length -
798 td_list->index - 1;
wdenk149dded2003-09-10 18:20:28 +0000799 } else
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900800 td_list->ed->hwHeadP &=
801 m32_swap(0xfffffff2);
wdenk149dded2003-09-10 18:20:28 +0000802 }
803 }
804
805 td_list->next_dl_td = td_rev;
806 td_rev = td_list;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900807 td_list_hc = m32_swap(td_list->hwNextTD) & 0xfffffff0;
wdenk149dded2003-09-10 18:20:28 +0000808 }
Wolfgang Denk9c998aa2005-07-21 11:57:57 +0200809
wdenk149dded2003-09-10 18:20:28 +0000810 return td_list;
811}
812
813/*-------------------------------------------------------------------------*/
814
815/* td done list */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900816static int dl_done_list(struct ohci *ohci, struct td *td_list)
wdenk149dded2003-09-10 18:20:28 +0000817{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900818 struct td *td_list_next = NULL;
819 struct ed *ed;
wdenk149dded2003-09-10 18:20:28 +0000820 int cc = 0;
821 int stat = 0;
822 /* urb_t *urb; */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900823 struct urb_priv *lurb_priv;
wdenk42d1f032003-10-15 23:53:47 +0000824 __u32 tdINFO, edHeadP, edTailP;
wdenk149dded2003-09-10 18:20:28 +0000825
wdenk42d1f032003-10-15 23:53:47 +0000826 while (td_list) {
827 td_list_next = td_list->next_dl_td;
wdenk149dded2003-09-10 18:20:28 +0000828
wdenk42d1f032003-10-15 23:53:47 +0000829 lurb_priv = &urb_priv;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900830 tdINFO = m32_swap(td_list->hwINFO);
wdenk149dded2003-09-10 18:20:28 +0000831
wdenk42d1f032003-10-15 23:53:47 +0000832 ed = td_list->ed;
wdenk149dded2003-09-10 18:20:28 +0000833
wdenk42d1f032003-10-15 23:53:47 +0000834 dl_transfer_length(td_list);
wdenk149dded2003-09-10 18:20:28 +0000835
wdenk42d1f032003-10-15 23:53:47 +0000836 /* error code of transfer */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900837 cc = TD_CC_GET(tdINFO);
wdenk149dded2003-09-10 18:20:28 +0000838 if (cc != 0) {
839 dbg("ConditionCode %#x", cc);
840 stat = cc_to_error[cc];
841 }
842
Wolfgang Denk9c998aa2005-07-21 11:57:57 +0200843 /* see if this done list makes for all TD's of current URB,
844 * and mark the URB finished if so */
845 if (++(lurb_priv->td_cnt) == lurb_priv->length) {
846 if ((ed->state & (ED_OPER | ED_UNLINK)))
847 urb_finished = 1;
848 else
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900849 dbg("dl_done_list: strange.., ED state %x, "
850 "ed->state\n");
Wolfgang Denk9c998aa2005-07-21 11:57:57 +0200851 } else
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900852 dbg("dl_done_list: processing TD %x, len %x\n",
853 lurb_priv->td_cnt, lurb_priv->length);
Wolfgang Denk9c998aa2005-07-21 11:57:57 +0200854
wdenk42d1f032003-10-15 23:53:47 +0000855 if (ed->state != ED_NEW) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900856 edHeadP = m32_swap(ed->hwHeadP) & 0xfffffff0;
857 edTailP = m32_swap(ed->hwTailP);
wdenk149dded2003-09-10 18:20:28 +0000858
859 /* unlink eds if they are not busy */
wdenk42d1f032003-10-15 23:53:47 +0000860 if ((edHeadP == edTailP) && (ed->state == ED_OPER))
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900861 ep_unlink(ohci, ed);
wdenk42d1f032003-10-15 23:53:47 +0000862 }
wdenk149dded2003-09-10 18:20:28 +0000863
wdenk42d1f032003-10-15 23:53:47 +0000864 td_list = td_list_next;
865 }
wdenk149dded2003-09-10 18:20:28 +0000866 return stat;
867}
868
869/*-------------------------------------------------------------------------*
870 * Virtual Root Hub
871 *-------------------------------------------------------------------------*/
872
Stephen Warreneb838e72014-02-13 21:15:18 -0700873#include <usbroothubdes.h>
wdenk149dded2003-09-10 18:20:28 +0000874
875/* Hub class-specific descriptor is constructed dynamically */
876
877
878/*-------------------------------------------------------------------------*/
879
Wolfgang Denk53677ef2008-05-20 16:00:29 +0200880#define OK(x) len = (x); break
wdenk149dded2003-09-10 18:20:28 +0000881#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900882#define WR_RH_STAT(x) \
883{ \
884 info("WR:status %#8x", (x)); \
885 writel((x), &gohci.regs->roothub.status); \
886}
887#define WR_RH_PORTSTAT(x) \
888{ \
889 info("WR:portstatus[%d] %#8x", wIndex-1, (x)); \
890 writel((x), &gohci.regs->roothub.portstatus[wIndex-1]); \
891}
wdenk149dded2003-09-10 18:20:28 +0000892#else
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900893#define WR_RH_STAT(x) \
894 writel((x), &gohci.regs->roothub.status)
895#define WR_RH_PORTSTAT(x)\
896 writel((x), &gohci.regs->roothub.portstatus[wIndex-1])
wdenk149dded2003-09-10 18:20:28 +0000897#endif
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900898#define RD_RH_STAT roothub_status(&gohci)
899#define RD_RH_PORTSTAT roothub_portstatus(&gohci, wIndex-1)
wdenk149dded2003-09-10 18:20:28 +0000900
901/* request to virtual root hub */
902
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900903int rh_check_port_status(struct ohci *controller)
dzu8a42eac2003-09-29 21:55:54 +0000904{
905 __u32 temp, ndp, i;
906 int res;
907
908 res = -1;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900909 temp = roothub_a(controller);
dzu8a42eac2003-09-29 21:55:54 +0000910 ndp = (temp & RH_A_NDP);
911 for (i = 0; i < ndp; i++) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900912 temp = roothub_portstatus(controller, i);
dzu8a42eac2003-09-29 21:55:54 +0000913 /* check for a device disconnect */
914 if (((temp & (RH_PS_PESC | RH_PS_CSC)) ==
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900915 (RH_PS_PESC | RH_PS_CSC)) && ((temp & RH_PS_CCS) == 0)) {
dzu8a42eac2003-09-29 21:55:54 +0000916 res = i;
917 break;
918 }
919 }
920 return res;
921}
922
923static int ohci_submit_rh_msg(struct usb_device *dev, unsigned long pipe,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900924 void *buffer, int transfer_len,
925 struct devrequest *cmd)
wdenk149dded2003-09-10 18:20:28 +0000926{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900927 void *data = buffer;
wdenk149dded2003-09-10 18:20:28 +0000928 int leni = transfer_len;
929 int len = 0;
930 int stat = 0;
Simon Glass13119bc2011-11-15 18:17:06 +0000931 union {
932 __u32 word[4];
933 __u16 hword[8];
934 __u8 byte[16];
935 } datab;
936 __u8 *data_buf = datab.byte;
wdenk42d1f032003-10-15 23:53:47 +0000937 __u16 bmRType_bReq;
wdenk149dded2003-09-10 18:20:28 +0000938 __u16 wValue;
939 __u16 wIndex;
940 __u16 wLength;
941
942#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900943 urb_priv.actual_length = 0;
944 pkt_print(dev, pipe, buffer, transfer_len, cmd, "SUB(rh)",
945 usb_pipein(pipe));
wdenk149dded2003-09-10 18:20:28 +0000946#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +0000947 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +0000948#endif
Remy Bohmer9dbc3662008-10-10 10:23:22 +0200949 if (usb_pipeint(pipe)) {
wdenk149dded2003-09-10 18:20:28 +0000950 info("Root-Hub submit IRQ: NOT implemented");
951 return 0;
952 }
953
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900954 bmRType_bReq = cmd->requesttype | (cmd->request << 8);
955 wValue = m16_swap(cmd->value);
956 wIndex = m16_swap(cmd->index);
957 wLength = m16_swap(cmd->length);
wdenk149dded2003-09-10 18:20:28 +0000958
959 info("Root-Hub: adr: %2x cmd(%1x): %08x %04x %04x %04x",
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900960 dev->devnum, 8, bmRType_bReq, wValue, wIndex, wLength);
wdenk149dded2003-09-10 18:20:28 +0000961
962 switch (bmRType_bReq) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900963 /* Request Destination:
964 without flags: Device,
965 RH_INTERFACE: interface,
966 RH_ENDPOINT: endpoint,
967 RH_CLASS means HUB here,
968 RH_OTHER | RH_CLASS almost ever means HUB_PORT here
969 */
wdenk149dded2003-09-10 18:20:28 +0000970
971 case RH_GET_STATUS:
Simon Glass13119bc2011-11-15 18:17:06 +0000972 datab.hword[0] = m16_swap(1);
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900973 OK(2);
wdenk149dded2003-09-10 18:20:28 +0000974 case RH_GET_STATUS | RH_INTERFACE:
Simon Glass13119bc2011-11-15 18:17:06 +0000975 datab.hword[0] = m16_swap(0);
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900976 OK(2);
wdenk149dded2003-09-10 18:20:28 +0000977 case RH_GET_STATUS | RH_ENDPOINT:
Simon Glass13119bc2011-11-15 18:17:06 +0000978 datab.hword[0] = m16_swap(0);
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900979 OK(2);
wdenk149dded2003-09-10 18:20:28 +0000980 case RH_GET_STATUS | RH_CLASS:
Simon Glass13119bc2011-11-15 18:17:06 +0000981 datab.word[0] =
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900982 m32_swap(RD_RH_STAT & ~(RH_HS_CRWE | RH_HS_DRWE));
983 OK(4);
wdenk149dded2003-09-10 18:20:28 +0000984 case RH_GET_STATUS | RH_OTHER | RH_CLASS:
Simon Glass13119bc2011-11-15 18:17:06 +0000985 datab.word[0] = m32_swap(RD_RH_PORTSTAT);
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900986 OK(4);
wdenk149dded2003-09-10 18:20:28 +0000987
988 case RH_CLEAR_FEATURE | RH_ENDPOINT:
989 switch (wValue) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900990 case (RH_ENDPOINT_STALL):
991 OK(0);
wdenk149dded2003-09-10 18:20:28 +0000992 }
993 break;
994
995 case RH_CLEAR_FEATURE | RH_CLASS:
996 switch (wValue) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +0900997 case RH_C_HUB_LOCAL_POWER:
998 OK(0);
999 case (RH_C_HUB_OVER_CURRENT):
1000 WR_RH_STAT(RH_HS_OCIC);
1001 OK(0);
wdenk149dded2003-09-10 18:20:28 +00001002 }
1003 break;
1004
1005 case RH_CLEAR_FEATURE | RH_OTHER | RH_CLASS:
1006 switch (wValue) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001007 case (RH_PORT_ENABLE):
1008 WR_RH_PORTSTAT(RH_PS_CCS);
1009 OK(0);
1010 case (RH_PORT_SUSPEND):
1011 WR_RH_PORTSTAT(RH_PS_POCI);
1012 OK(0);
1013 case (RH_PORT_POWER):
1014 WR_RH_PORTSTAT(RH_PS_LSDA);
1015 OK(0);
1016 case (RH_C_PORT_CONNECTION):
1017 WR_RH_PORTSTAT(RH_PS_CSC);
1018 OK(0);
1019 case (RH_C_PORT_ENABLE):
1020 WR_RH_PORTSTAT(RH_PS_PESC);
1021 OK(0);
1022 case (RH_C_PORT_SUSPEND):
1023 WR_RH_PORTSTAT(RH_PS_PSSC);
1024 OK(0);
1025 case (RH_C_PORT_OVER_CURRENT):
1026 WR_RH_PORTSTAT(RH_PS_OCIC);
1027 OK(0);
1028 case (RH_C_PORT_RESET):
1029 WR_RH_PORTSTAT(RH_PS_PRSC);
1030 OK(0);
wdenk149dded2003-09-10 18:20:28 +00001031 }
1032 break;
1033
1034 case RH_SET_FEATURE | RH_OTHER | RH_CLASS:
1035 switch (wValue) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001036 case (RH_PORT_SUSPEND):
1037 WR_RH_PORTSTAT(RH_PS_PSS);
1038 OK(0);
1039 case (RH_PORT_RESET): /* BUG IN HUP CODE ******** */
1040 if (RD_RH_PORTSTAT & RH_PS_CCS)
1041 WR_RH_PORTSTAT(RH_PS_PRS);
1042 OK(0);
1043 case (RH_PORT_POWER):
1044 WR_RH_PORTSTAT(RH_PS_PPS);
1045 OK(0);
1046 case (RH_PORT_ENABLE): /* BUG IN HUP CODE ******** */
1047 if (RD_RH_PORTSTAT & RH_PS_CCS)
1048 WR_RH_PORTSTAT(RH_PS_PES);
1049 OK(0);
wdenk149dded2003-09-10 18:20:28 +00001050 }
1051 break;
1052
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001053 case RH_SET_ADDRESS:
1054 gohci.rh.devnum = wValue;
1055 OK(0);
wdenk149dded2003-09-10 18:20:28 +00001056
1057 case RH_GET_DESCRIPTOR:
1058 switch ((wValue & 0xff00) >> 8) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001059 case (0x01): /* device descriptor */
1060 len = min_t(unsigned int,
1061 leni,
1062 min_t(unsigned int,
1063 sizeof(root_hub_dev_des), wLength));
1064 data_buf = root_hub_dev_des;
1065 OK(len);
1066 case (0x02): /* configuration descriptor */
1067 len = min_t(unsigned int,
1068 leni,
1069 min_t(unsigned int,
1070 sizeof(root_hub_config_des),
1071 wLength));
1072 data_buf = root_hub_config_des;
1073 OK(len);
1074 case (0x03): /* string descriptors */
1075 if (wValue == 0x0300) {
wdenk149dded2003-09-10 18:20:28 +00001076 len = min_t(unsigned int,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001077 leni,
1078 min_t(unsigned int,
1079 sizeof(root_hub_str_index0),
1080 wLength));
1081 data_buf = root_hub_str_index0;
1082 OK(len);
wdenk149dded2003-09-10 18:20:28 +00001083 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001084 if (wValue == 0x0301) {
1085 len = min_t(unsigned int,
1086 leni,
1087 min_t(unsigned int,
1088 sizeof(root_hub_str_index1),
1089 wLength));
1090 data_buf = root_hub_str_index1;
1091 OK(len);
1092 }
1093 default:
1094 stat = USB_ST_STALLED;
wdenk149dded2003-09-10 18:20:28 +00001095 }
1096 break;
1097
1098 case RH_GET_DESCRIPTOR | RH_CLASS:
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001099 {
1100 __u32 temp = roothub_a(&gohci);
wdenk149dded2003-09-10 18:20:28 +00001101
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001102 data_buf[0] = 9; /* min length; */
1103 data_buf[1] = 0x29;
1104 data_buf[2] = temp & RH_A_NDP;
1105 data_buf[3] = 0;
1106 if (temp & RH_A_PSM)
1107 /* per-port power switching? */
1108 data_buf[3] |= 0x1;
1109 if (temp & RH_A_NOCP)
1110 /* no overcurrent reporting? */
1111 data_buf[3] |= 0x10;
1112 else if (temp & RH_A_OCPM)
1113 /* per-port overcurrent reporting? */
1114 data_buf[3] |= 0x8;
wdenk149dded2003-09-10 18:20:28 +00001115
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001116 /* corresponds to data_buf[4-7] */
Simon Glass13119bc2011-11-15 18:17:06 +00001117 datab.word[1] = 0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001118 data_buf[5] = (temp & RH_A_POTPGT) >> 24;
1119 temp = roothub_b(&gohci);
1120 data_buf[7] = temp & RH_B_DR;
1121 if (data_buf[2] < 7) {
1122 data_buf[8] = 0xff;
1123 } else {
1124 data_buf[0] += 2;
1125 data_buf[8] = (temp & RH_B_DR) >> 8;
1126 data_buf[10] = data_buf[9] = 0xff;
1127 }
wdenk149dded2003-09-10 18:20:28 +00001128
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001129 len = min_t(unsigned int, leni,
1130 min_t(unsigned int, data_buf[0], wLength));
1131 OK(len);
wdenk149dded2003-09-10 18:20:28 +00001132 }
1133
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001134 case RH_GET_CONFIGURATION:
1135 *(__u8 *) data_buf = 0x01;
1136 OK(1);
wdenk149dded2003-09-10 18:20:28 +00001137
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001138 case RH_SET_CONFIGURATION:
1139 WR_RH_STAT(0x10000);
1140 OK(0);
wdenk149dded2003-09-10 18:20:28 +00001141
1142 default:
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001143 dbg("unsupported root hub command");
wdenk149dded2003-09-10 18:20:28 +00001144 stat = USB_ST_STALLED;
1145 }
1146
1147#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001148 ohci_dump_roothub(&gohci, 1);
wdenk149dded2003-09-10 18:20:28 +00001149#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001150 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001151#endif
1152
1153 len = min_t(int, len, leni);
1154 if (data != data_buf)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001155 memcpy(data, data_buf, len);
wdenk42d1f032003-10-15 23:53:47 +00001156 dev->act_len = len;
wdenk149dded2003-09-10 18:20:28 +00001157 dev->status = stat;
1158
1159#ifdef DEBUG
1160 if (transfer_len)
1161 urb_priv.actual_length = transfer_len;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001162 pkt_print(dev, pipe, buffer, transfer_len, cmd, "RET(rh)",
1163 0 /*usb_pipein(pipe) */);
wdenk149dded2003-09-10 18:20:28 +00001164#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001165 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001166#endif
1167
1168 return stat;
1169}
1170
1171/*-------------------------------------------------------------------------*/
1172
1173/* common code for handling submit messages - used for all but root hub */
1174/* accesses. */
1175int submit_common_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001176 int transfer_len, struct devrequest *setup, int interval)
wdenk149dded2003-09-10 18:20:28 +00001177{
1178 int stat = 0;
1179 int maxsize = usb_maxpacket(dev, pipe);
1180 int timeout;
1181
dzu8a42eac2003-09-29 21:55:54 +00001182 /* device pulled? Shortcut the action. */
1183 if (devgone == dev) {
1184 dev->status = USB_ST_CRC_ERR;
1185 return 0;
1186 }
wdenk149dded2003-09-10 18:20:28 +00001187#ifdef DEBUG
1188 urb_priv.actual_length = 0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001189 pkt_print(dev, pipe, buffer, transfer_len, setup, "SUB",
1190 usb_pipein(pipe));
wdenk149dded2003-09-10 18:20:28 +00001191#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001192 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001193#endif
1194 if (!maxsize) {
1195 err("submit_common_message: pipesize for pipe %lx is zero",
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001196 pipe);
wdenk149dded2003-09-10 18:20:28 +00001197 return -1;
1198 }
1199
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001200 if (sohci_submit_job(dev, pipe, buffer, transfer_len, setup, interval) <
1201 0) {
wdenk149dded2003-09-10 18:20:28 +00001202 err("sohci_submit_job failed");
1203 return -1;
1204 }
1205
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001206 mdelay(10);
wdenk149dded2003-09-10 18:20:28 +00001207 /* ohci_dump_status(&gohci); */
wdenk42d1f032003-10-15 23:53:47 +00001208
wdenka43278a2003-09-11 19:48:06 +00001209 /* allow more time for a BULK device to react - some are slow */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001210#define BULK_TO 5000 /* timeout in milliseconds */
Remy Bohmer9dbc3662008-10-10 10:23:22 +02001211 if (usb_pipebulk(pipe))
wdenka43278a2003-09-11 19:48:06 +00001212 timeout = BULK_TO;
1213 else
1214 timeout = 100;
1215
wdenk149dded2003-09-10 18:20:28 +00001216 /* wait for it to complete */
wdenk149dded2003-09-10 18:20:28 +00001217 for (;;) {
1218 /* check whether the controller is done */
1219 stat = hc_interrupt();
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001220
wdenk149dded2003-09-10 18:20:28 +00001221 if (stat < 0) {
dzu8a42eac2003-09-29 21:55:54 +00001222 stat = USB_ST_CRC_ERR;
wdenk149dded2003-09-10 18:20:28 +00001223 break;
1224 }
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001225
1226 /* NOTE: since we are not interrupt driven in U-Boot and always
1227 * handle only one URB at a time, we cannot assume the
1228 * transaction finished on the first successful return from
1229 * hc_interrupt().. unless the flag for current URB is set,
1230 * meaning that all TD's to/from device got actually
1231 * transferred and processed. If the current URB is not
1232 * finished we need to re-iterate this loop so as
1233 * hc_interrupt() gets called again as there needs to be some
1234 * more TD's to process still */
1235 if ((stat >= 0) && (stat != 0xff) && (urb_finished)) {
wdenk149dded2003-09-10 18:20:28 +00001236 /* 0xff is returned for an SF-interrupt */
1237 break;
1238 }
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001239
wdenk149dded2003-09-10 18:20:28 +00001240 if (--timeout) {
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001241 mdelay(1);
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001242 if (!urb_finished)
1243 dbg("\%");
Wolfgang Denk095b8a32005-08-02 17:06:17 +02001244
wdenk149dded2003-09-10 18:20:28 +00001245 } else {
dzu8a42eac2003-09-29 21:55:54 +00001246 err("CTL:TIMEOUT ");
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001247 dbg("submit_common_msg: TO status %x\n", stat);
dzu8a42eac2003-09-29 21:55:54 +00001248 stat = USB_ST_CRC_ERR;
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001249 urb_finished = 1;
wdenk149dded2003-09-10 18:20:28 +00001250 break;
1251 }
1252 }
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001253
1254#if 0
dzu8a42eac2003-09-29 21:55:54 +00001255 /* we got an Root Hub Status Change interrupt */
1256 if (got_rhsc) {
1257#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001258 ohci_dump_roothub(&gohci, 1);
dzu8a42eac2003-09-29 21:55:54 +00001259#endif
1260 got_rhsc = 0;
1261 /* abuse timeout */
1262 timeout = rh_check_port_status(&gohci);
1263 if (timeout >= 0) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001264#if 0 /* this does nothing useful, but leave it here
1265 in case that changes */
dzu8a42eac2003-09-29 21:55:54 +00001266 /* the called routine adds 1 to the passed value */
1267 usb_hub_port_connect_change(gohci.rh.dev, timeout - 1);
1268#endif
1269 /*
1270 * XXX
1271 * This is potentially dangerous because it assumes
1272 * that only one device is ever plugged in!
1273 */
1274 devgone = dev;
1275 }
1276 }
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001277#endif
dzu8a42eac2003-09-29 21:55:54 +00001278
wdenk149dded2003-09-10 18:20:28 +00001279 dev->status = stat;
wdenk42d1f032003-10-15 23:53:47 +00001280 dev->act_len = transfer_len;
wdenk149dded2003-09-10 18:20:28 +00001281
1282#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001283 pkt_print(dev, pipe, buffer, transfer_len, setup, "RET(ctlr)",
1284 usb_pipein(pipe));
wdenk149dded2003-09-10 18:20:28 +00001285#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001286 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001287#endif
1288
1289 /* free TDs in urb_priv */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001290 urb_free_priv(&urb_priv);
wdenk149dded2003-09-10 18:20:28 +00001291 return 0;
1292}
1293
1294/* submit routines called from usb.c */
1295int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001296 int transfer_len)
wdenk149dded2003-09-10 18:20:28 +00001297{
1298 info("submit_bulk_msg");
1299 return submit_common_msg(dev, pipe, buffer, transfer_len, NULL, 0);
1300}
1301
1302int submit_control_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001303 int transfer_len, struct devrequest *setup)
wdenk149dded2003-09-10 18:20:28 +00001304{
1305 int maxsize = usb_maxpacket(dev, pipe);
1306
1307 info("submit_control_msg");
1308#ifdef DEBUG
1309 urb_priv.actual_length = 0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001310 pkt_print(dev, pipe, buffer, transfer_len, setup, "SUB",
1311 usb_pipein(pipe));
wdenk149dded2003-09-10 18:20:28 +00001312#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001313 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001314#endif
1315 if (!maxsize) {
1316 err("submit_control_message: pipesize for pipe %lx is zero",
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001317 pipe);
wdenk149dded2003-09-10 18:20:28 +00001318 return -1;
1319 }
dzu8a42eac2003-09-29 21:55:54 +00001320 if (((pipe >> 8) & 0x7f) == gohci.rh.devnum) {
1321 gohci.rh.dev = dev;
wdenk149dded2003-09-10 18:20:28 +00001322 /* root hub - redirect */
1323 return ohci_submit_rh_msg(dev, pipe, buffer, transfer_len,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001324 setup);
dzu8a42eac2003-09-29 21:55:54 +00001325 }
wdenk149dded2003-09-10 18:20:28 +00001326
1327 return submit_common_msg(dev, pipe, buffer, transfer_len, setup, 0);
1328}
1329
1330int submit_int_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001331 int transfer_len, int interval)
wdenk149dded2003-09-10 18:20:28 +00001332{
1333 info("submit_int_msg");
1334 return -1;
1335}
1336
1337/*-------------------------------------------------------------------------*
1338 * HC functions
1339 *-------------------------------------------------------------------------*/
1340
1341/* reset the HC and BUS */
1342
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001343static int hc_reset(struct ohci *ohci)
wdenk149dded2003-09-10 18:20:28 +00001344{
1345 int timeout = 30;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001346 int smm_timeout = 50; /* 0,5 sec */
wdenk149dded2003-09-10 18:20:28 +00001347
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001348 if (readl(&ohci->regs->control) & OHCI_CTRL_IR) {
1349 /* SMM owns the HC - request ownership */
1350 writel(OHCI_OCR, &ohci->regs->cmdstatus);
wdenk149dded2003-09-10 18:20:28 +00001351 info("USB HC TakeOver from SMM");
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001352 while (readl(&ohci->regs->control) & OHCI_CTRL_IR) {
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001353 mdelay(10);
wdenk149dded2003-09-10 18:20:28 +00001354 if (--smm_timeout == 0) {
1355 err("USB HC TakeOver failed!");
1356 return -1;
1357 }
1358 }
1359 }
1360
1361 /* Disable HC interrupts */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001362 writel(OHCI_INTR_MIE, &ohci->regs->intrdisable);
wdenk149dded2003-09-10 18:20:28 +00001363
1364 dbg("USB HC reset_hc usb-%s: ctrl = 0x%X ;",
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001365 ohci->slot_name, readl(&ohci->regs->control));
wdenk149dded2003-09-10 18:20:28 +00001366
wdenk42d1f032003-10-15 23:53:47 +00001367 /* Reset USB (needed by some controllers) */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001368 writel(0, &ohci->regs->control);
wdenk149dded2003-09-10 18:20:28 +00001369
1370 /* HC Reset requires max 10 us delay */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001371 writel(OHCI_HCR, &ohci->regs->cmdstatus);
1372 while ((readl(&ohci->regs->cmdstatus) & OHCI_HCR) != 0) {
wdenk149dded2003-09-10 18:20:28 +00001373 if (--timeout == 0) {
1374 err("USB HC reset timed out!");
1375 return -1;
1376 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001377 udelay(1);
wdenk149dded2003-09-10 18:20:28 +00001378 }
1379 return 0;
1380}
1381
1382/*-------------------------------------------------------------------------*/
1383
1384/* Start an OHCI controller, set the BUS operational
1385 * enable interrupts
1386 * connect the virtual root hub */
1387
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001388static int hc_start(struct ohci *ohci)
wdenk149dded2003-09-10 18:20:28 +00001389{
wdenk42d1f032003-10-15 23:53:47 +00001390 __u32 mask;
1391 unsigned int fminterval;
wdenk149dded2003-09-10 18:20:28 +00001392
1393 ohci->disabled = 1;
1394
1395 /* Tell the controller where the control and bulk lists are
1396 * The lists are empty now. */
1397
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001398 writel(0, &ohci->regs->ed_controlhead);
1399 writel(0, &ohci->regs->ed_bulkhead);
wdenk149dded2003-09-10 18:20:28 +00001400
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001401 /* a reset clears this */
1402 writel((__u32) ohci->hcca, &ohci->regs->hcca);
wdenk149dded2003-09-10 18:20:28 +00001403
wdenk42d1f032003-10-15 23:53:47 +00001404 fminterval = 0x2edf;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001405 writel((fminterval * 9) / 10, &ohci->regs->periodicstart);
wdenk149dded2003-09-10 18:20:28 +00001406 fminterval |= ((((fminterval - 210) * 6) / 7) << 16);
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001407 writel(fminterval, &ohci->regs->fminterval);
1408 writel(0x628, &ohci->regs->lsthresh);
wdenk149dded2003-09-10 18:20:28 +00001409
wdenk42d1f032003-10-15 23:53:47 +00001410 /* start controller operations */
1411 ohci->hc_control = OHCI_CONTROL_INIT | OHCI_USB_OPER;
wdenk149dded2003-09-10 18:20:28 +00001412 ohci->disabled = 0;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001413 writel(ohci->hc_control, &ohci->regs->control);
wdenk149dded2003-09-10 18:20:28 +00001414
dzu8a42eac2003-09-29 21:55:54 +00001415 /* disable all interrupts */
1416 mask = (OHCI_INTR_SO | OHCI_INTR_WDH | OHCI_INTR_SF | OHCI_INTR_RD |
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001417 OHCI_INTR_UE | OHCI_INTR_FNO | OHCI_INTR_RHSC |
1418 OHCI_INTR_OC | OHCI_INTR_MIE);
1419 writel(mask, &ohci->regs->intrdisable);
dzu8a42eac2003-09-29 21:55:54 +00001420 /* clear all interrupts */
1421 mask &= ~OHCI_INTR_MIE;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001422 writel(mask, &ohci->regs->intrstatus);
dzu8a42eac2003-09-29 21:55:54 +00001423 /* Choose the interrupts we care about now - but w/o MIE */
1424 mask = OHCI_INTR_RHSC | OHCI_INTR_UE | OHCI_INTR_WDH | OHCI_INTR_SO;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001425 writel(mask, &ohci->regs->intrenable);
wdenk149dded2003-09-10 18:20:28 +00001426
1427#ifdef OHCI_USE_NPS
1428 /* required for AMD-756 and some Mac platforms */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001429 writel((roothub_a(ohci) | RH_A_NPS) & ~RH_A_PSM,
1430 &ohci->regs->roothub.a);
1431 writel(RH_HS_LPSC, &ohci->regs->roothub.status);
1432#endif /* OHCI_USE_NPS */
wdenk149dded2003-09-10 18:20:28 +00001433
wdenk149dded2003-09-10 18:20:28 +00001434 /* POTPGT delay is bits 24-31, in 2 ms units. */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001435 mdelay((roothub_a(ohci) >> 23) & 0x1fe);
wdenk149dded2003-09-10 18:20:28 +00001436
1437 /* connect the virtual root hub */
1438 ohci->rh.devnum = 0;
1439
1440 return 0;
1441}
1442
1443/*-------------------------------------------------------------------------*/
1444
1445/* an interrupt happens */
1446
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001447static int hc_interrupt(void)
wdenk149dded2003-09-10 18:20:28 +00001448{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001449 struct ohci *ohci = &gohci;
wdenk149dded2003-09-10 18:20:28 +00001450 struct ohci_regs *regs = ohci->regs;
wdenk42d1f032003-10-15 23:53:47 +00001451 int ints;
wdenk149dded2003-09-10 18:20:28 +00001452 int stat = -1;
1453
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001454 if ((ohci->hcca->done_head != 0) &&
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001455 !(m32_swap(ohci->hcca->done_head) & 0x01)) {
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001456
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001457 ints = OHCI_INTR_WDH;
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001458
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001459 } else {
1460 ints = readl(&regs->intrstatus);
1461 if (ints == ~(u32) 0) {
1462 ohci->disabled++;
1463 err("%s device removed!", ohci->slot_name);
1464 return -1;
1465 }
1466 ints &= readl(&regs->intrenable);
1467 if (ints == 0) {
1468 dbg("hc_interrupt: returning..\n");
1469 return 0xff;
1470 }
wdenk149dded2003-09-10 18:20:28 +00001471 }
1472
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001473 /* dbg("Interrupt: %x frame: %x", ints,
1474 le16_to_cpu(ohci->hcca->frame_no)); */
wdenk149dded2003-09-10 18:20:28 +00001475
dzu8a42eac2003-09-29 21:55:54 +00001476 if (ints & OHCI_INTR_RHSC) {
1477 got_rhsc = 1;
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001478 stat = 0xff;
dzu8a42eac2003-09-29 21:55:54 +00001479 }
1480
wdenk149dded2003-09-10 18:20:28 +00001481 if (ints & OHCI_INTR_UE) {
1482 ohci->disabled++;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001483 err("OHCI Unrecoverable Error, controller usb-%s disabled",
1484 ohci->slot_name);
wdenk149dded2003-09-10 18:20:28 +00001485 /* e.g. due to PCI Master/Target Abort */
1486
1487#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001488 ohci_dump(ohci, 1);
wdenk149dded2003-09-10 18:20:28 +00001489#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001490 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001491#endif
1492 /* FIXME: be optimistic, hope that bug won't repeat often. */
1493 /* Make some non-interrupt context restart the controller. */
1494 /* Count and limit the retries though; either hardware or */
1495 /* software errors can go forever... */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001496 hc_reset(ohci);
wdenk149dded2003-09-10 18:20:28 +00001497 return -1;
1498 }
1499
1500 if (ints & OHCI_INTR_WDH) {
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001501 mdelay(1);
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001502
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001503 writel(OHCI_INTR_WDH, &regs->intrdisable);
1504 stat = dl_done_list(&gohci, dl_reverse_done_list(&gohci));
1505 writel(OHCI_INTR_WDH, &regs->intrenable);
wdenk149dded2003-09-10 18:20:28 +00001506 }
1507
1508 if (ints & OHCI_INTR_SO) {
1509 dbg("USB Schedule overrun\n");
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001510 writel(OHCI_INTR_SO, &regs->intrenable);
wdenk149dded2003-09-10 18:20:28 +00001511 stat = -1;
1512 }
1513
1514 /* FIXME: this assumes SOF (1/ms) interrupts don't get lost... */
1515 if (ints & OHCI_INTR_SF) {
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001516 unsigned int frame = m16_swap(ohci->hcca->frame_no) & 1;
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001517 mdelay(1);
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001518 writel(OHCI_INTR_SF, &regs->intrdisable);
wdenk149dded2003-09-10 18:20:28 +00001519 if (ohci->ed_rm_list[frame] != NULL)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001520 writel(OHCI_INTR_SF, &regs->intrenable);
wdenk149dded2003-09-10 18:20:28 +00001521 stat = 0xff;
1522 }
1523
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001524 writel(ints, &regs->intrstatus);
wdenk149dded2003-09-10 18:20:28 +00001525 return stat;
1526}
1527
1528/*-------------------------------------------------------------------------*/
1529
1530/*-------------------------------------------------------------------------*/
1531
1532/* De-allocate all resources.. */
1533
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001534static void hc_release_ohci(struct ohci *ohci)
wdenk149dded2003-09-10 18:20:28 +00001535{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001536 dbg("USB HC release ohci usb-%s", ohci->slot_name);
wdenk149dded2003-09-10 18:20:28 +00001537
1538 if (!ohci->disabled)
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001539 hc_reset(ohci);
wdenk149dded2003-09-10 18:20:28 +00001540}
1541
1542/*-------------------------------------------------------------------------*/
1543
1544/*
1545 * low level initalisation routine, called from usb.c
1546 */
1547static char ohci_inited = 0;
1548
Troy Kisky06d513e2013-10-10 15:27:56 -07001549int usb_lowlevel_init(int index, enum usb_init_type init, void **controller)
wdenk149dded2003-09-10 18:20:28 +00001550{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001551 struct s3c24x0_clock_power *clk_power = s3c24x0_get_base_clock_power();
1552 struct s3c24x0_gpio *gpio = s3c24x0_get_base_gpio();
wdenk149dded2003-09-10 18:20:28 +00001553
wdenk42d1f032003-10-15 23:53:47 +00001554 /*
1555 * Set the 48 MHz UPLL clocking. Values are taken from
1556 * "PLL value selection guide", 6-23, s3c2400_UM.pdf.
1557 */
C Naumand9abba82010-10-26 23:04:31 +09001558 clk_power->upllcon = ((40 << 12) + (1 << 4) + 2);
1559 gpio->misccr |= 0x8; /* 1 = use pads related USB for USB host */
wdenk149dded2003-09-10 18:20:28 +00001560
wdenk42d1f032003-10-15 23:53:47 +00001561 /*
1562 * Enable USB host clock.
1563 */
C Naumand9abba82010-10-26 23:04:31 +09001564 clk_power->clkcon |= (1 << 4);
wdenk149dded2003-09-10 18:20:28 +00001565
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001566 memset(&gohci, 0, sizeof(struct ohci));
1567 memset(&urb_priv, 0, sizeof(struct urb_priv));
wdenk149dded2003-09-10 18:20:28 +00001568
1569 /* align the storage */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001570 if ((__u32) &ghcca[0] & 0xff) {
wdenk149dded2003-09-10 18:20:28 +00001571 err("HCCA not aligned!!");
1572 return -1;
1573 }
1574 phcca = &ghcca[0];
1575 info("aligned ghcca %p", phcca);
1576 memset(&ohci_dev, 0, sizeof(struct ohci_device));
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001577 if ((__u32) &ohci_dev.ed[0] & 0x7) {
wdenk149dded2003-09-10 18:20:28 +00001578 err("EDs not aligned!!");
1579 return -1;
1580 }
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001581 memset(gtd, 0, sizeof(struct td) * (NUM_TD + 1));
1582 if ((__u32) gtd & 0x7) {
wdenk149dded2003-09-10 18:20:28 +00001583 err("TDs not aligned!!");
1584 return -1;
1585 }
1586 ptd = gtd;
1587 gohci.hcca = phcca;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001588 memset(phcca, 0, sizeof(struct ohci_hcca));
wdenk149dded2003-09-10 18:20:28 +00001589
1590 gohci.disabled = 1;
1591 gohci.sleeping = 0;
1592 gohci.irq = -1;
1593 gohci.regs = (struct ohci_regs *)S3C24X0_USB_HOST_BASE;
1594
1595 gohci.flags = 0;
1596 gohci.slot_name = "s3c2400";
1597
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001598 if (hc_reset(&gohci) < 0) {
1599 hc_release_ohci(&gohci);
wdenk42d1f032003-10-15 23:53:47 +00001600 /* Initialization failed */
C Naumand9abba82010-10-26 23:04:31 +09001601 clk_power->clkcon &= ~(1 << 4);
wdenk149dded2003-09-10 18:20:28 +00001602 return -1;
1603 }
1604
1605 /* FIXME this is a second HC reset; why?? */
Wolfgang Denkd2ed2f62006-03-11 23:07:09 +01001606 gohci.hc_control = OHCI_USB_RESET;
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001607 writel(gohci.hc_control, &gohci.regs->control);
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001608 mdelay(10);
wdenk149dded2003-09-10 18:20:28 +00001609
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001610 if (hc_start(&gohci) < 0) {
1611 err("can't start usb-%s", gohci.slot_name);
1612 hc_release_ohci(&gohci);
wdenk42d1f032003-10-15 23:53:47 +00001613 /* Initialization failed */
C Naumand9abba82010-10-26 23:04:31 +09001614 clk_power->clkcon &= ~(1 << 4);
wdenk149dded2003-09-10 18:20:28 +00001615 return -1;
1616 }
wdenk149dded2003-09-10 18:20:28 +00001617#ifdef DEBUG
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001618 ohci_dump(&gohci, 1);
wdenk149dded2003-09-10 18:20:28 +00001619#else
Mike Frysinger5b84dd62012-03-05 13:47:00 +00001620 mdelay(1);
wdenk149dded2003-09-10 18:20:28 +00001621#endif
1622 ohci_inited = 1;
Wolfgang Denk9c998aa2005-07-21 11:57:57 +02001623 urb_finished = 1;
1624
wdenk149dded2003-09-10 18:20:28 +00001625 return 0;
1626}
1627
Lucas Stachc7e3b2b2012-09-26 00:14:34 +02001628int usb_lowlevel_stop(int index)
wdenk149dded2003-09-10 18:20:28 +00001629{
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001630 struct s3c24x0_clock_power *clk_power = s3c24x0_get_base_clock_power();
wdenk149dded2003-09-10 18:20:28 +00001631
1632 /* this gets called really early - before the controller has */
1633 /* even been initialized! */
1634 if (!ohci_inited)
1635 return 0;
1636 /* TODO release any interrupts, etc. */
1637 /* call hc_release_ohci() here ? */
kevin.morfitt@fearnside-systems.co.ukd67cce22009-10-10 13:30:22 +09001638 hc_reset(&gohci);
wdenk149dded2003-09-10 18:20:28 +00001639 /* may not want to do this */
C Naumand9abba82010-10-26 23:04:31 +09001640 clk_power->clkcon &= ~(1 << 4);
wdenk149dded2003-09-10 18:20:28 +00001641 return 0;
1642}
1643
kevin.morfitt@fearnside-systems.co.ukac678042009-11-17 18:30:34 +09001644#endif /* defined(CONFIG_USB_OHCI) && defined(CONFIG_S3C24X0) */
Marek Vasutfb24ffc2012-07-21 05:02:22 +00001645
1646#if defined(CONFIG_USB_OHCI_NEW) && \
1647 defined(CONFIG_SYS_USB_OHCI_CPU_INIT) && \
1648 defined(CONFIG_S3C24X0)
1649
1650int usb_cpu_init(void)
1651{
1652 struct s3c24x0_clock_power *clk_power = s3c24x0_get_base_clock_power();
1653 struct s3c24x0_gpio *gpio = s3c24x0_get_base_gpio();
1654
1655 /*
1656 * Set the 48 MHz UPLL clocking. Values are taken from
1657 * "PLL value selection guide", 6-23, s3c2400_UM.pdf.
1658 */
1659 writel((40 << 12) + (1 << 4) + 2, &clk_power->upllcon);
1660 /* 1 = use pads related USB for USB host */
1661 writel(readl(&gpio->misccr) | 0x8, &gpio->misccr);
1662
1663 /*
1664 * Enable USB host clock.
1665 */
1666 writel(readl(&clk_power->clkcon) | (1 << 4), &clk_power->clkcon);
1667
1668 return 0;
1669}
1670
1671int usb_cpu_stop(void)
1672{
1673 struct s3c24x0_clock_power *clk_power = s3c24x0_get_base_clock_power();
1674 /* may not want to do this */
1675 writel(readl(&clk_power->clkcon) & ~(1 << 4), &clk_power->clkcon);
1676 return 0;
1677}
1678
1679int usb_cpu_init_fail(void)
1680{
1681 struct s3c24x0_clock_power *clk_power = s3c24x0_get_base_clock_power();
1682 writel(readl(&clk_power->clkcon) & ~(1 << 4), &clk_power->clkcon);
1683 return 0;
1684}
1685
1686#endif /* defined(CONFIG_USB_OHCI_NEW) && \
1687 defined(CONFIG_SYS_USB_OHCI_CPU_INIT) && \
1688 defined(CONFIG_S3C24X0) */