blob: 6b2bf4684f45436caa95d7c16afe49fbeb2a6ff8 [file] [log] [blame]
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001/*
2 * Driver for the NXP ISP1760 chip
3 *
4 * However, the code might contain some bugs. What doesn't work for sure is:
5 * - ISO
6 * - OTG
7 e The interrupt line is configured as active low, level.
8 *
9 * (c) 2007 Sebastian Siewior <bigeasy@linutronix.de>
10 *
11 */
12#include <linux/module.h>
13#include <linux/kernel.h>
14#include <linux/slab.h>
15#include <linux/list.h>
16#include <linux/usb.h>
Eric Lescouet27729aa2010-04-24 23:21:52 +020017#include <linux/usb/hcd.h>
Sebastian Siewiordb11e472008-04-24 00:37:04 +020018#include <linux/debugfs.h>
19#include <linux/uaccess.h>
20#include <linux/io.h>
Catalin Marinasdb8516f2010-02-02 15:31:02 +000021#include <linux/mm.h>
Sebastian Siewiordb11e472008-04-24 00:37:04 +020022#include <asm/unaligned.h>
Catalin Marinasdb8516f2010-02-02 15:31:02 +000023#include <asm/cacheflush.h>
Sebastian Siewiordb11e472008-04-24 00:37:04 +020024
Sebastian Siewiordb11e472008-04-24 00:37:04 +020025#include "isp1760-hcd.h"
26
27static struct kmem_cache *qtd_cachep;
28static struct kmem_cache *qh_cachep;
29
30struct isp1760_hcd {
31 u32 hcs_params;
32 spinlock_t lock;
33 struct inter_packet_info atl_ints[32];
34 struct inter_packet_info int_ints[32];
35 struct memory_chunk memory_pool[BLOCKS];
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +010036 u32 atl_queued;
Sebastian Siewiordb11e472008-04-24 00:37:04 +020037
38 /* periodic schedule support */
39#define DEFAULT_I_TDPS 1024
40 unsigned periodic_size;
41 unsigned i_thresh;
42 unsigned long reset_done;
43 unsigned long next_statechange;
Nate Case3faefc82008-06-17 11:11:38 -050044 unsigned int devflags;
Sebastian Siewiordb11e472008-04-24 00:37:04 +020045};
46
47static inline struct isp1760_hcd *hcd_to_priv(struct usb_hcd *hcd)
48{
49 return (struct isp1760_hcd *) (hcd->hcd_priv);
50}
Sebastian Siewiordb11e472008-04-24 00:37:04 +020051
52/* Section 2.2 Host Controller Capability Registers */
53#define HC_LENGTH(p) (((p)>>00)&0x00ff) /* bits 7:0 */
54#define HC_VERSION(p) (((p)>>16)&0xffff) /* bits 31:16 */
55#define HCS_INDICATOR(p) ((p)&(1 << 16)) /* true: has port indicators */
56#define HCS_PPC(p) ((p)&(1 << 4)) /* true: port power control */
57#define HCS_N_PORTS(p) (((p)>>0)&0xf) /* bits 3:0, ports on HC */
58#define HCC_ISOC_CACHE(p) ((p)&(1 << 7)) /* true: can cache isoc frame */
59#define HCC_ISOC_THRES(p) (((p)>>4)&0x7) /* bits 6:4, uframes cached */
60
61/* Section 2.3 Host Controller Operational Registers */
62#define CMD_LRESET (1<<7) /* partial reset (no ports, etc) */
63#define CMD_RESET (1<<1) /* reset HC not bus */
64#define CMD_RUN (1<<0) /* start/stop HC */
65#define STS_PCD (1<<2) /* port change detect */
66#define FLAG_CF (1<<0) /* true: we'll support "high speed" */
67
68#define PORT_OWNER (1<<13) /* true: companion hc owns this port */
69#define PORT_POWER (1<<12) /* true: has power (see PPC) */
70#define PORT_USB11(x) (((x) & (3 << 10)) == (1 << 10)) /* USB 1.1 device */
71#define PORT_RESET (1<<8) /* reset port */
72#define PORT_SUSPEND (1<<7) /* suspend port */
73#define PORT_RESUME (1<<6) /* resume it */
74#define PORT_PE (1<<2) /* port enable */
75#define PORT_CSC (1<<1) /* connect status change */
76#define PORT_CONNECT (1<<0) /* device connected */
77#define PORT_RWC_BITS (PORT_CSC)
78
79struct isp1760_qtd {
Sebastian Siewiordb11e472008-04-24 00:37:04 +020080 u8 packet_type;
Sebastian Siewiordb11e472008-04-24 00:37:04 +020081 void *data_buffer;
Arvid Brodina041d8e2011-02-26 22:04:40 +010082 u32 payload_addr;
83
Sebastian Siewiordb11e472008-04-24 00:37:04 +020084 /* the rest is HCD-private */
85 struct list_head qtd_list;
86 struct urb *urb;
87 size_t length;
88
89 /* isp special*/
90 u32 status;
Sebastian Siewiordb11e472008-04-24 00:37:04 +020091#define URB_ENQUEUED (1 << 1)
Sebastian Siewiordb11e472008-04-24 00:37:04 +020092};
93
94struct isp1760_qh {
95 /* first part defined by EHCI spec */
96 struct list_head qtd_list;
Sebastian Siewiordb11e472008-04-24 00:37:04 +020097
Sebastian Siewiordb11e472008-04-24 00:37:04 +020098 u32 toggle;
99 u32 ping;
100};
101
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100102/*
103 * Access functions for isp176x registers (addresses 0..0x03FF).
104 */
105static u32 reg_read32(void __iomem *base, u32 reg)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200106{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100107 return readl(base + reg);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200108}
109
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100110static void reg_write32(void __iomem *base, u32 reg, u32 val)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200111{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100112 writel(val, base + reg);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200113}
114
115/*
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100116 * Access functions for isp176x memory (offset >= 0x0400).
117 *
118 * bank_reads8() reads memory locations prefetched by an earlier write to
119 * HC_MEMORY_REG (see isp176x datasheet). Unless you want to do fancy multi-
120 * bank optimizations, you should use the more generic mem_reads8() below.
121 *
122 * For access to ptd memory, use the specialized ptd_read() and ptd_write()
123 * below.
124 *
125 * These functions copy via MMIO data to/from the device. memcpy_{to|from}io()
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200126 * doesn't quite work because some people have to enforce 32-bit access
127 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100128static void bank_reads8(void __iomem *src_base, u32 src_offset, u32 bank_addr,
129 __u32 *dst, u32 bytes)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200130{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100131 __u32 __iomem *src;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200132 u32 val;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100133 __u8 *src_byteptr;
134 __u8 *dst_byteptr;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200135
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100136 src = src_base + (bank_addr | src_offset);
137
138 if (src_offset < PAYLOAD_OFFSET) {
139 while (bytes >= 4) {
140 *dst = le32_to_cpu(__raw_readl(src));
141 bytes -= 4;
142 src++;
143 dst++;
144 }
145 } else {
146 while (bytes >= 4) {
147 *dst = __raw_readl(src);
148 bytes -= 4;
149 src++;
150 dst++;
151 }
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200152 }
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200153
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100154 if (!bytes)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200155 return;
156
157 /* in case we have 3, 2 or 1 by left. The dst buffer may not be fully
158 * allocated.
159 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100160 if (src_offset < PAYLOAD_OFFSET)
161 val = le32_to_cpu(__raw_readl(src));
162 else
163 val = __raw_readl(src);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200164
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100165 dst_byteptr = (void *) dst;
166 src_byteptr = (void *) &val;
167 while (bytes > 0) {
168 *dst_byteptr = *src_byteptr;
169 dst_byteptr++;
170 src_byteptr++;
171 bytes--;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200172 }
173}
174
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100175static void mem_reads8(void __iomem *src_base, u32 src_offset, void *dst,
176 u32 bytes)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200177{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100178 reg_write32(src_base, HC_MEMORY_REG, src_offset + ISP_BANK(0));
179 ndelay(90);
180 bank_reads8(src_base, src_offset, ISP_BANK(0), dst, bytes);
181}
182
183static void mem_writes8(void __iomem *dst_base, u32 dst_offset,
184 __u32 const *src, u32 bytes)
185{
186 __u32 __iomem *dst;
187
188 dst = dst_base + dst_offset;
189
190 if (dst_offset < PAYLOAD_OFFSET) {
191 while (bytes >= 4) {
192 __raw_writel(cpu_to_le32(*src), dst);
193 bytes -= 4;
194 src++;
195 dst++;
196 }
197 } else {
198 while (bytes >= 4) {
199 __raw_writel(*src, dst);
200 bytes -= 4;
201 src++;
202 dst++;
203 }
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200204 }
205
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100206 if (!bytes)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200207 return;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100208 /* in case we have 3, 2 or 1 bytes left. The buffer is allocated and the
209 * extra bytes should not be read by the HW.
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200210 */
211
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100212 if (dst_offset < PAYLOAD_OFFSET)
213 __raw_writel(cpu_to_le32(*src), dst);
214 else
215 __raw_writel(*src, dst);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200216}
217
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100218/*
219 * Read and write ptds. 'ptd_offset' should be one of ISO_PTD_OFFSET,
220 * INT_PTD_OFFSET, and ATL_PTD_OFFSET. 'slot' should be less than 32.
221 */
222static void ptd_read(void __iomem *base, u32 ptd_offset, u32 slot,
223 struct ptd *ptd)
224{
225 reg_write32(base, HC_MEMORY_REG,
226 ISP_BANK(0) + ptd_offset + slot*sizeof(*ptd));
227 ndelay(90);
228 bank_reads8(base, ptd_offset + slot*sizeof(*ptd), ISP_BANK(0),
229 (void *) ptd, sizeof(*ptd));
230}
231
232static void ptd_write(void __iomem *base, u32 ptd_offset, u32 slot,
233 struct ptd *ptd)
234{
235 mem_writes8(base, ptd_offset + slot*sizeof(*ptd) + sizeof(ptd->dw0),
236 &ptd->dw1, 7*sizeof(ptd->dw1));
237 /* Make sure dw0 gets written last (after other dw's and after payload)
238 since it contains the enable bit */
239 wmb();
240 mem_writes8(base, ptd_offset + slot*sizeof(*ptd), &ptd->dw0,
241 sizeof(ptd->dw0));
242}
243
244
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200245/* memory management of the 60kb on the chip from 0x1000 to 0xffff */
246static void init_memory(struct isp1760_hcd *priv)
247{
Arvid Brodina041d8e2011-02-26 22:04:40 +0100248 int i, curr;
249 u32 payload_addr;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200250
Arvid Brodina041d8e2011-02-26 22:04:40 +0100251 payload_addr = PAYLOAD_OFFSET;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200252 for (i = 0; i < BLOCK_1_NUM; i++) {
Arvid Brodina041d8e2011-02-26 22:04:40 +0100253 priv->memory_pool[i].start = payload_addr;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200254 priv->memory_pool[i].size = BLOCK_1_SIZE;
255 priv->memory_pool[i].free = 1;
Arvid Brodina041d8e2011-02-26 22:04:40 +0100256 payload_addr += priv->memory_pool[i].size;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200257 }
258
Arvid Brodina041d8e2011-02-26 22:04:40 +0100259 curr = i;
260 for (i = 0; i < BLOCK_2_NUM; i++) {
261 priv->memory_pool[curr + i].start = payload_addr;
262 priv->memory_pool[curr + i].size = BLOCK_2_SIZE;
263 priv->memory_pool[curr + i].free = 1;
264 payload_addr += priv->memory_pool[curr + i].size;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200265 }
266
Arvid Brodina041d8e2011-02-26 22:04:40 +0100267 curr = i;
268 for (i = 0; i < BLOCK_3_NUM; i++) {
269 priv->memory_pool[curr + i].start = payload_addr;
270 priv->memory_pool[curr + i].size = BLOCK_3_SIZE;
271 priv->memory_pool[curr + i].free = 1;
272 payload_addr += priv->memory_pool[curr + i].size;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200273 }
274
Arvid Brodin34537732011-04-26 21:47:37 +0200275 WARN_ON(payload_addr - priv->memory_pool[0].start > PAYLOAD_AREA_SIZE);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200276}
277
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100278static void alloc_mem(struct usb_hcd *hcd, struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200279{
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100280 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200281 int i;
282
Arvid Brodin34537732011-04-26 21:47:37 +0200283 WARN_ON(qtd->payload_addr);
Arvid Brodina041d8e2011-02-26 22:04:40 +0100284
285 if (!qtd->length)
286 return;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200287
288 for (i = 0; i < BLOCKS; i++) {
Arvid Brodina041d8e2011-02-26 22:04:40 +0100289 if (priv->memory_pool[i].size >= qtd->length &&
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200290 priv->memory_pool[i].free) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200291 priv->memory_pool[i].free = 0;
Arvid Brodina041d8e2011-02-26 22:04:40 +0100292 qtd->payload_addr = priv->memory_pool[i].start;
293 return;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200294 }
295 }
296
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100297 dev_err(hcd->self.controller,
Randy Dunlapd06847f2011-03-15 17:09:10 -0700298 "%s: Cannot allocate %zu bytes of memory\n"
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100299 "Current memory map:\n",
300 __func__, qtd->length);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200301 for (i = 0; i < BLOCKS; i++) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100302 dev_err(hcd->self.controller, "Pool %2d size %4d status: %d\n",
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200303 i, priv->memory_pool[i].size,
304 priv->memory_pool[i].free);
305 }
306 /* XXX maybe -ENOMEM could be possible */
307 BUG();
Arvid Brodina041d8e2011-02-26 22:04:40 +0100308 return;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200309}
310
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100311static void free_mem(struct usb_hcd *hcd, struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200312{
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100313 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200314 int i;
315
Arvid Brodina041d8e2011-02-26 22:04:40 +0100316 if (!qtd->payload_addr)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200317 return;
318
319 for (i = 0; i < BLOCKS; i++) {
Arvid Brodina041d8e2011-02-26 22:04:40 +0100320 if (priv->memory_pool[i].start == qtd->payload_addr) {
Arvid Brodin34537732011-04-26 21:47:37 +0200321 WARN_ON(priv->memory_pool[i].free);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200322 priv->memory_pool[i].free = 1;
Arvid Brodina041d8e2011-02-26 22:04:40 +0100323 qtd->payload_addr = 0;
324 return;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200325 }
326 }
327
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100328 dev_err(hcd->self.controller, "%s: Invalid pointer: %08x\n",
329 __func__, qtd->payload_addr);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200330 BUG();
331}
332
333static void isp1760_init_regs(struct usb_hcd *hcd)
334{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100335 reg_write32(hcd->regs, HC_BUFFER_STATUS_REG, 0);
336 reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, NO_TRANSFER_ACTIVE);
337 reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, NO_TRANSFER_ACTIVE);
338 reg_write32(hcd->regs, HC_ISO_PTD_SKIPMAP_REG, NO_TRANSFER_ACTIVE);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200339
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100340 reg_write32(hcd->regs, HC_ATL_PTD_DONEMAP_REG, ~NO_TRANSFER_ACTIVE);
341 reg_write32(hcd->regs, HC_INT_PTD_DONEMAP_REG, ~NO_TRANSFER_ACTIVE);
342 reg_write32(hcd->regs, HC_ISO_PTD_DONEMAP_REG, ~NO_TRANSFER_ACTIVE);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200343}
344
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100345static int handshake(struct usb_hcd *hcd, u32 reg,
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200346 u32 mask, u32 done, int usec)
347{
348 u32 result;
349
350 do {
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100351 result = reg_read32(hcd->regs, reg);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200352 if (result == ~0)
353 return -ENODEV;
354 result &= mask;
355 if (result == done)
356 return 0;
357 udelay(1);
358 usec--;
359 } while (usec > 0);
360 return -ETIMEDOUT;
361}
362
363/* reset a non-running (STS_HALT == 1) controller */
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100364static int ehci_reset(struct usb_hcd *hcd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200365{
366 int retval;
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100367 struct isp1760_hcd *priv = hcd_to_priv(hcd);
368
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100369 u32 command = reg_read32(hcd->regs, HC_USBCMD);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200370
371 command |= CMD_RESET;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100372 reg_write32(hcd->regs, HC_USBCMD, command);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200373 hcd->state = HC_STATE_HALT;
374 priv->next_statechange = jiffies;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100375 retval = handshake(hcd, HC_USBCMD,
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200376 CMD_RESET, 0, 250 * 1000);
377 return retval;
378}
379
380static void qh_destroy(struct isp1760_qh *qh)
381{
Arvid Brodin34537732011-04-26 21:47:37 +0200382 WARN_ON(!list_empty(&qh->qtd_list));
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200383 kmem_cache_free(qh_cachep, qh);
384}
385
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100386static struct isp1760_qh *isp1760_qh_alloc(gfp_t flags)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200387{
388 struct isp1760_qh *qh;
389
390 qh = kmem_cache_zalloc(qh_cachep, flags);
391 if (!qh)
392 return qh;
393
394 INIT_LIST_HEAD(&qh->qtd_list);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200395 return qh;
396}
397
398/* magic numbers that can affect system performance */
399#define EHCI_TUNE_CERR 3 /* 0-3 qtd retries; 0 == don't stop */
400#define EHCI_TUNE_RL_HS 4 /* nak throttle; see 4.9 */
401#define EHCI_TUNE_RL_TT 0
402#define EHCI_TUNE_MULT_HS 1 /* 1-3 transactions/uframe; 4.10.3 */
403#define EHCI_TUNE_MULT_TT 1
404#define EHCI_TUNE_FLS 2 /* (small) 256 frame schedule */
405
406/* one-time init, only for memory state */
407static int priv_init(struct usb_hcd *hcd)
408{
409 struct isp1760_hcd *priv = hcd_to_priv(hcd);
410 u32 hcc_params;
411
412 spin_lock_init(&priv->lock);
413
414 /*
415 * hw default: 1K periodic list heads, one per frame.
416 * periodic_size can shrink by USBCMD update if hcc_params allows.
417 */
418 priv->periodic_size = DEFAULT_I_TDPS;
419
420 /* controllers may cache some of the periodic schedule ... */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100421 hcc_params = reg_read32(hcd->regs, HC_HCCPARAMS);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200422 /* full frame cache */
423 if (HCC_ISOC_CACHE(hcc_params))
424 priv->i_thresh = 8;
425 else /* N microframes cached */
426 priv->i_thresh = 2 + HCC_ISOC_THRES(hcc_params);
427
428 return 0;
429}
430
431static int isp1760_hc_setup(struct usb_hcd *hcd)
432{
433 struct isp1760_hcd *priv = hcd_to_priv(hcd);
434 int result;
Nate Case3faefc82008-06-17 11:11:38 -0500435 u32 scratch, hwmode;
436
437 /* Setup HW Mode Control: This assumes a level active-low interrupt */
438 hwmode = HW_DATA_BUS_32BIT;
439
440 if (priv->devflags & ISP1760_FLAG_BUS_WIDTH_16)
441 hwmode &= ~HW_DATA_BUS_32BIT;
442 if (priv->devflags & ISP1760_FLAG_ANALOG_OC)
443 hwmode |= HW_ANA_DIGI_OC;
444 if (priv->devflags & ISP1760_FLAG_DACK_POL_HIGH)
445 hwmode |= HW_DACK_POL_HIGH;
446 if (priv->devflags & ISP1760_FLAG_DREQ_POL_HIGH)
447 hwmode |= HW_DREQ_POL_HIGH;
Michael Hennerich9da69c62009-07-15 23:22:54 -0400448 if (priv->devflags & ISP1760_FLAG_INTR_POL_HIGH)
449 hwmode |= HW_INTR_HIGH_ACT;
450 if (priv->devflags & ISP1760_FLAG_INTR_EDGE_TRIG)
451 hwmode |= HW_INTR_EDGE_TRIG;
Nate Case3faefc82008-06-17 11:11:38 -0500452
453 /*
454 * We have to set this first in case we're in 16-bit mode.
455 * Write it twice to ensure correct upper bits if switching
456 * to 16-bit mode.
457 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100458 reg_write32(hcd->regs, HC_HW_MODE_CTRL, hwmode);
459 reg_write32(hcd->regs, HC_HW_MODE_CTRL, hwmode);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200460
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100461 reg_write32(hcd->regs, HC_SCRATCH_REG, 0xdeadbabe);
Nate Case3faefc82008-06-17 11:11:38 -0500462 /* Change bus pattern */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100463 scratch = reg_read32(hcd->regs, HC_CHIP_ID_REG);
464 scratch = reg_read32(hcd->regs, HC_SCRATCH_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200465 if (scratch != 0xdeadbabe) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100466 dev_err(hcd->self.controller, "Scratch test failed.\n");
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200467 return -ENODEV;
468 }
469
470 /* pre reset */
471 isp1760_init_regs(hcd);
472
473 /* reset */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100474 reg_write32(hcd->regs, HC_RESET_REG, SW_RESET_RESET_ALL);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200475 mdelay(100);
476
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100477 reg_write32(hcd->regs, HC_RESET_REG, SW_RESET_RESET_HC);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200478 mdelay(100);
479
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100480 result = ehci_reset(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200481 if (result)
482 return result;
483
484 /* Step 11 passed */
485
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100486 dev_info(hcd->self.controller, "bus width: %d, oc: %s\n",
Nate Case3faefc82008-06-17 11:11:38 -0500487 (priv->devflags & ISP1760_FLAG_BUS_WIDTH_16) ?
488 16 : 32, (priv->devflags & ISP1760_FLAG_ANALOG_OC) ?
489 "analog" : "digital");
490
491 /* ATL reset */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100492 reg_write32(hcd->regs, HC_HW_MODE_CTRL, hwmode | ALL_ATX_RESET);
Nate Case3faefc82008-06-17 11:11:38 -0500493 mdelay(10);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100494 reg_write32(hcd->regs, HC_HW_MODE_CTRL, hwmode);
Nate Case3faefc82008-06-17 11:11:38 -0500495
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100496 reg_write32(hcd->regs, HC_INTERRUPT_REG, INTERRUPT_ENABLE_MASK);
497 reg_write32(hcd->regs, HC_INTERRUPT_ENABLE, INTERRUPT_ENABLE_MASK);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200498
Nate Case3faefc82008-06-17 11:11:38 -0500499 /*
500 * PORT 1 Control register of the ISP1760 is the OTG control
Thomas Hommel42c65392008-12-18 10:31:40 +0100501 * register on ISP1761. Since there is no OTG or device controller
502 * support in this driver, we use port 1 as a "normal" USB host port on
503 * both chips.
Nate Case3faefc82008-06-17 11:11:38 -0500504 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100505 reg_write32(hcd->regs, HC_PORT1_CTRL, PORT1_POWER | PORT1_INIT2);
Thomas Hommel42c65392008-12-18 10:31:40 +0100506 mdelay(10);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200507
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100508 priv->hcs_params = reg_read32(hcd->regs, HC_HCSPARAMS);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200509
510 return priv_init(hcd);
511}
512
513static void isp1760_init_maps(struct usb_hcd *hcd)
514{
515 /*set last maps, for iso its only 1, else 32 tds bitmap*/
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100516 reg_write32(hcd->regs, HC_ATL_PTD_LASTPTD_REG, 0x80000000);
517 reg_write32(hcd->regs, HC_INT_PTD_LASTPTD_REG, 0x80000000);
518 reg_write32(hcd->regs, HC_ISO_PTD_LASTPTD_REG, 0x00000001);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200519}
520
521static void isp1760_enable_interrupts(struct usb_hcd *hcd)
522{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100523 reg_write32(hcd->regs, HC_ATL_IRQ_MASK_AND_REG, 0);
524 reg_write32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG, 0);
525 reg_write32(hcd->regs, HC_INT_IRQ_MASK_AND_REG, 0);
526 reg_write32(hcd->regs, HC_INT_IRQ_MASK_OR_REG, 0);
527 reg_write32(hcd->regs, HC_ISO_IRQ_MASK_AND_REG, 0);
528 reg_write32(hcd->regs, HC_ISO_IRQ_MASK_OR_REG, 0xffffffff);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200529 /* step 23 passed */
530}
531
532static int isp1760_run(struct usb_hcd *hcd)
533{
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200534 int retval;
535 u32 temp;
536 u32 command;
537 u32 chipid;
538
539 hcd->uses_new_polling = 1;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200540
541 hcd->state = HC_STATE_RUNNING;
542 isp1760_enable_interrupts(hcd);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100543 temp = reg_read32(hcd->regs, HC_HW_MODE_CTRL);
544 reg_write32(hcd->regs, HC_HW_MODE_CTRL, temp | HW_GLOBAL_INTR_EN);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200545
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100546 command = reg_read32(hcd->regs, HC_USBCMD);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200547 command &= ~(CMD_LRESET|CMD_RESET);
548 command |= CMD_RUN;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100549 reg_write32(hcd->regs, HC_USBCMD, command);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200550
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100551 retval = handshake(hcd, HC_USBCMD, CMD_RUN, CMD_RUN,
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200552 250 * 1000);
553 if (retval)
554 return retval;
555
556 /*
557 * XXX
558 * Spec says to write FLAG_CF as last config action, priv code grabs
559 * the semaphore while doing so.
560 */
561 down_write(&ehci_cf_port_reset_rwsem);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100562 reg_write32(hcd->regs, HC_CONFIGFLAG, FLAG_CF);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200563
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100564 retval = handshake(hcd, HC_CONFIGFLAG, FLAG_CF, FLAG_CF, 250 * 1000);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200565 up_write(&ehci_cf_port_reset_rwsem);
566 if (retval)
567 return retval;
568
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100569 chipid = reg_read32(hcd->regs, HC_CHIP_ID_REG);
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100570 dev_info(hcd->self.controller, "USB ISP %04x HW rev. %d started\n",
571 chipid & 0xffff, chipid >> 16);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200572
573 /* PTD Register Init Part 2, Step 28 */
574 /* enable INTs */
575 isp1760_init_maps(hcd);
576
577 /* GRR this is run-once init(), being done every time the HC starts.
578 * So long as they're part of class devices, we can't do it init()
579 * since the class device isn't created that early.
580 */
581 return 0;
582}
583
584static u32 base_to_chip(u32 base)
585{
586 return ((base - 0x400) >> 3);
587}
588
Arvid Brodin7adc14b12011-02-26 22:08:47 +0100589static int last_qtd_of_urb(struct isp1760_qtd *qtd, struct isp1760_qh *qh)
590{
591 struct urb *urb;
592
593 if (list_is_last(&qtd->qtd_list, &qh->qtd_list))
594 return 1;
595
596 urb = qtd->urb;
597 qtd = list_entry(qtd->qtd_list.next, typeof(*qtd), qtd_list);
598 return (qtd->urb != urb);
599}
600
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100601static void transform_into_atl(struct isp1760_qh *qh,
Arvid Brodina041d8e2011-02-26 22:04:40 +0100602 struct isp1760_qtd *qtd, struct ptd *ptd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200603{
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200604 u32 maxpacket;
605 u32 multi;
606 u32 pid_code;
607 u32 rl = RL_COUNTER;
608 u32 nak = NAK_COUNTER;
609
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100610 memset(ptd, 0, sizeof(*ptd));
611
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200612 /* according to 3.6.2, max packet len can not be > 0x400 */
Arvid Brodina041d8e2011-02-26 22:04:40 +0100613 maxpacket = usb_maxpacket(qtd->urb->dev, qtd->urb->pipe,
614 usb_pipeout(qtd->urb->pipe));
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200615 multi = 1 + ((maxpacket >> 11) & 0x3);
616 maxpacket &= 0x7ff;
617
618 /* DW0 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100619 ptd->dw0 = PTD_VALID;
620 ptd->dw0 |= PTD_LENGTH(qtd->length);
621 ptd->dw0 |= PTD_MAXPACKET(maxpacket);
Arvid Brodina041d8e2011-02-26 22:04:40 +0100622 ptd->dw0 |= PTD_ENDPOINT(usb_pipeendpoint(qtd->urb->pipe));
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200623
624 /* DW1 */
Arvid Brodina041d8e2011-02-26 22:04:40 +0100625 ptd->dw1 = usb_pipeendpoint(qtd->urb->pipe) >> 1;
626 ptd->dw1 |= PTD_DEVICE_ADDR(usb_pipedevice(qtd->urb->pipe));
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200627
628 pid_code = qtd->packet_type;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100629 ptd->dw1 |= PTD_PID_TOKEN(pid_code);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200630
Arvid Brodina041d8e2011-02-26 22:04:40 +0100631 if (usb_pipebulk(qtd->urb->pipe))
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100632 ptd->dw1 |= PTD_TRANS_BULK;
Arvid Brodina041d8e2011-02-26 22:04:40 +0100633 else if (usb_pipeint(qtd->urb->pipe))
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100634 ptd->dw1 |= PTD_TRANS_INT;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200635
Arvid Brodina041d8e2011-02-26 22:04:40 +0100636 if (qtd->urb->dev->speed != USB_SPEED_HIGH) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200637 /* split transaction */
638
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100639 ptd->dw1 |= PTD_TRANS_SPLIT;
Arvid Brodina041d8e2011-02-26 22:04:40 +0100640 if (qtd->urb->dev->speed == USB_SPEED_LOW)
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100641 ptd->dw1 |= PTD_SE_USB_LOSPEED;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200642
Arvid Brodina041d8e2011-02-26 22:04:40 +0100643 ptd->dw1 |= PTD_PORT_NUM(qtd->urb->dev->ttport);
644 ptd->dw1 |= PTD_HUB_NUM(qtd->urb->dev->tt->hub->devnum);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200645
646 /* SE bit for Split INT transfers */
Arvid Brodina041d8e2011-02-26 22:04:40 +0100647 if (usb_pipeint(qtd->urb->pipe) &&
648 (qtd->urb->dev->speed == USB_SPEED_LOW))
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100649 ptd->dw1 |= 2 << 16;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200650
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100651 ptd->dw3 = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200652 rl = 0;
653 nak = 0;
654 } else {
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100655 ptd->dw0 |= PTD_MULTI(multi);
Arvid Brodina041d8e2011-02-26 22:04:40 +0100656 if (usb_pipecontrol(qtd->urb->pipe) ||
657 usb_pipebulk(qtd->urb->pipe))
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100658 ptd->dw3 = qh->ping;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200659 else
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100660 ptd->dw3 = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200661 }
662 /* DW2 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100663 ptd->dw2 = 0;
Arvid Brodina041d8e2011-02-26 22:04:40 +0100664 ptd->dw2 |= PTD_DATA_START_ADDR(base_to_chip(qtd->payload_addr));
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100665 ptd->dw2 |= PTD_RL_CNT(rl);
666 ptd->dw3 |= PTD_NAC_CNT(nak);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200667
668 /* DW3 */
Arvid Brodin7adc14b12011-02-26 22:08:47 +0100669 ptd->dw3 |= qh->toggle;
670 if (usb_pipecontrol(qtd->urb->pipe)) {
671 if (qtd->data_buffer == qtd->urb->setup_packet)
672 ptd->dw3 &= ~PTD_DATA_TOGGLE(1);
673 else if (last_qtd_of_urb(qtd, qh))
674 ptd->dw3 |= PTD_DATA_TOGGLE(1);
675 }
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200676
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100677 ptd->dw3 |= PTD_ACTIVE;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200678 /* Cerr */
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100679 ptd->dw3 |= PTD_CERR(ERR_COUNTER);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200680}
681
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100682static void transform_add_int(struct isp1760_qh *qh,
Arvid Brodina041d8e2011-02-26 22:04:40 +0100683 struct isp1760_qtd *qtd, struct ptd *ptd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200684{
Arvid Brodin65f1b522011-02-26 22:07:35 +0100685 u32 usof;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200686 u32 period;
687
Arvid Brodin65f1b522011-02-26 22:07:35 +0100688 /*
689 * Most of this is guessing. ISP1761 datasheet is quite unclear, and
690 * the algorithm from the original Philips driver code, which was
691 * pretty much used in this driver before as well, is quite horrendous
692 * and, i believe, incorrect. The code below follows the datasheet and
693 * USB2.0 spec as far as I can tell, and plug/unplug seems to be much
694 * more reliable this way (fingers crossed...).
695 */
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200696
Arvid Brodin65f1b522011-02-26 22:07:35 +0100697 if (qtd->urb->dev->speed == USB_SPEED_HIGH) {
698 /* urb->interval is in units of microframes (1/8 ms) */
699 period = qtd->urb->interval >> 3;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200700
Arvid Brodin65f1b522011-02-26 22:07:35 +0100701 if (qtd->urb->interval > 4)
702 usof = 0x01; /* One bit set =>
703 interval 1 ms * uFrame-match */
704 else if (qtd->urb->interval > 2)
705 usof = 0x22; /* Two bits set => interval 1/2 ms */
706 else if (qtd->urb->interval > 1)
707 usof = 0x55; /* Four bits set => interval 1/4 ms */
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200708 else
Arvid Brodin65f1b522011-02-26 22:07:35 +0100709 usof = 0xff; /* All bits set => interval 1/8 ms */
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200710 } else {
Arvid Brodin65f1b522011-02-26 22:07:35 +0100711 /* urb->interval is in units of frames (1 ms) */
712 period = qtd->urb->interval;
713 usof = 0x0f; /* Execute Start Split on any of the
714 four first uFrames */
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200715
Arvid Brodin65f1b522011-02-26 22:07:35 +0100716 /*
717 * First 8 bits in dw5 is uSCS and "specifies which uSOF the
718 * complete split needs to be sent. Valid only for IN." Also,
719 * "All bits can be set to one for every transfer." (p 82,
720 * ISP1761 data sheet.) 0x1c is from Philips driver. Where did
721 * that number come from? 0xff seems to work fine...
722 */
723 /* ptd->dw5 = 0x1c; */
724 ptd->dw5 = 0xff; /* Execute Complete Split on any uFrame */
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200725 }
726
Arvid Brodin65f1b522011-02-26 22:07:35 +0100727 period = period >> 1;/* Ensure equal or shorter period than requested */
728 period &= 0xf8; /* Mask off too large values and lowest unused 3 bits */
729
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100730 ptd->dw2 |= period;
731 ptd->dw4 = usof;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200732}
733
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100734static void transform_into_int(struct isp1760_qh *qh,
Arvid Brodina041d8e2011-02-26 22:04:40 +0100735 struct isp1760_qtd *qtd, struct ptd *ptd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200736{
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100737 transform_into_atl(qh, qtd, ptd);
738 transform_add_int(qh, qtd, ptd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200739}
740
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100741static int check_error(struct usb_hcd *hcd, struct ptd *ptd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200742{
743 int error = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200744
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100745 if (ptd->dw3 & DW3_HALT_BIT) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200746 error = -EPIPE;
747
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100748 if (ptd->dw3 & DW3_ERROR_BIT)
Anton Vorontsov0954e1c2010-05-07 01:09:19 +0400749 pr_err("error bit is set in DW3\n");
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200750 }
751
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100752 if (ptd->dw3 & DW3_QTD_ACTIVE) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100753 dev_err(hcd->self.controller, "Transfer active bit is set DW3\n"
754 "nak counter: %d, rl: %d\n",
755 (ptd->dw3 >> 19) & 0xf, (ptd->dw2 >> 25) & 0xf);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200756 }
757
758 return error;
759}
760
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100761static void check_int_err_status(struct usb_hcd *hcd, u32 dw4)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200762{
763 u32 i;
764
765 dw4 >>= 8;
766
767 for (i = 0; i < 8; i++) {
768 switch (dw4 & 0x7) {
769 case INT_UNDERRUN:
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100770 dev_err(hcd->self.controller, "Underrun (%d)\n", i);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200771 break;
772
773 case INT_EXACT:
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100774 dev_err(hcd->self.controller,
775 "Transaction error (%d)\n", i);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200776 break;
777
778 case INT_BABBLE:
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100779 dev_err(hcd->self.controller, "Babble error (%d)\n", i);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200780 break;
781 }
782 dw4 >>= 3;
783 }
784}
785
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100786static void enqueue_one_qtd(struct usb_hcd *hcd, struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200787{
Arvid Brodina041d8e2011-02-26 22:04:40 +0100788 if (qtd->length && (qtd->length <= MAX_PAYLOAD_SIZE)) {
789 switch (qtd->packet_type) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200790 case IN_PID:
791 break;
792 case OUT_PID:
793 case SETUP_PID:
Arvid Brodina041d8e2011-02-26 22:04:40 +0100794 mem_writes8(hcd->regs, qtd->payload_addr,
795 qtd->data_buffer, qtd->length);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200796 }
797 }
798}
799
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100800static void enqueue_one_atl_qtd(struct usb_hcd *hcd, struct isp1760_qh *qh,
801 u32 slot, struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200802{
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100803 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200804 struct ptd ptd;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200805
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100806 alloc_mem(hcd, qtd);
807 transform_into_atl(qh, qtd, &ptd);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100808 ptd_write(hcd->regs, ATL_PTD_OFFSET, slot, &ptd);
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100809 enqueue_one_qtd(hcd, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200810
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200811 priv->atl_ints[slot].qh = qh;
812 priv->atl_ints[slot].qtd = qtd;
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100813 qtd->status |= URB_ENQUEUED;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200814 qtd->status |= slot << 16;
815}
816
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100817static void enqueue_one_int_qtd(struct usb_hcd *hcd, struct isp1760_qh *qh,
818 u32 slot, struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200819{
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100820 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200821 struct ptd ptd;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200822
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100823 alloc_mem(hcd, qtd);
824 transform_into_int(qh, qtd, &ptd);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100825 ptd_write(hcd->regs, INT_PTD_OFFSET, slot, &ptd);
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100826 enqueue_one_qtd(hcd, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200827
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200828 priv->int_ints[slot].qh = qh;
829 priv->int_ints[slot].qtd = qtd;
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100830 qtd->status |= URB_ENQUEUED;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200831 qtd->status |= slot << 16;
832}
833
Adrian Bunk473bca92008-05-05 21:25:33 +0300834static void enqueue_an_ATL_packet(struct usb_hcd *hcd, struct isp1760_qh *qh,
835 struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200836{
837 struct isp1760_hcd *priv = hcd_to_priv(hcd);
838 u32 skip_map, or_map;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200839 u32 slot;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200840 u32 buffstatus;
841
Catalin Marinase6bdfe32009-03-23 12:38:16 +0000842 /*
843 * When this function is called from the interrupt handler to enqueue
844 * a follow-up packet, the SKIP register gets written and read back
845 * almost immediately. With ISP1761, this register requires a delay of
846 * 195ns between a write and subsequent read (see section 15.1.1.3).
847 */
Michael Hennerichebb8a4e2010-08-05 17:53:57 -0400848 mmiowb();
Catalin Marinase6bdfe32009-03-23 12:38:16 +0000849 ndelay(195);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100850 skip_map = reg_read32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200851
852 BUG_ON(!skip_map);
853 slot = __ffs(skip_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200854
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100855 enqueue_one_atl_qtd(hcd, qh, slot, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200856
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100857 or_map = reg_read32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG);
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100858 or_map |= (1 << slot);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100859 reg_write32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG, or_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200860
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100861 skip_map &= ~(1 << slot);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100862 reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, skip_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200863
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +0100864 priv->atl_queued++;
865 if (priv->atl_queued == 2)
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100866 reg_write32(hcd->regs, HC_INTERRUPT_ENABLE,
867 INTERRUPT_ENABLE_SOT_MASK);
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +0100868
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100869 buffstatus = reg_read32(hcd->regs, HC_BUFFER_STATUS_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200870 buffstatus |= ATL_BUFFER;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100871 reg_write32(hcd->regs, HC_BUFFER_STATUS_REG, buffstatus);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200872}
873
Adrian Bunk473bca92008-05-05 21:25:33 +0300874static void enqueue_an_INT_packet(struct usb_hcd *hcd, struct isp1760_qh *qh,
875 struct isp1760_qtd *qtd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200876{
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200877 u32 skip_map, or_map;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200878 u32 slot;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200879 u32 buffstatus;
880
Catalin Marinase6bdfe32009-03-23 12:38:16 +0000881 /*
882 * When this function is called from the interrupt handler to enqueue
883 * a follow-up packet, the SKIP register gets written and read back
884 * almost immediately. With ISP1761, this register requires a delay of
885 * 195ns between a write and subsequent read (see section 15.1.1.3).
886 */
Michael Hennerichebb8a4e2010-08-05 17:53:57 -0400887 mmiowb();
Catalin Marinase6bdfe32009-03-23 12:38:16 +0000888 ndelay(195);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100889 skip_map = reg_read32(hcd->regs, HC_INT_PTD_SKIPMAP_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200890
891 BUG_ON(!skip_map);
892 slot = __ffs(skip_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200893
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100894 enqueue_one_int_qtd(hcd, qh, slot, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200895
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100896 or_map = reg_read32(hcd->regs, HC_INT_IRQ_MASK_OR_REG);
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100897 or_map |= (1 << slot);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100898 reg_write32(hcd->regs, HC_INT_IRQ_MASK_OR_REG, or_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200899
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100900 skip_map &= ~(1 << slot);
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100901 reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, skip_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200902
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100903 buffstatus = reg_read32(hcd->regs, HC_BUFFER_STATUS_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200904 buffstatus |= INT_BUFFER;
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100905 reg_write32(hcd->regs, HC_BUFFER_STATUS_REG, buffstatus);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200906}
907
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100908static void isp1760_urb_done(struct usb_hcd *hcd, struct urb *urb)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200909__releases(priv->lock)
910__acquires(priv->lock)
911{
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100912 struct isp1760_hcd *priv = hcd_to_priv(hcd);
913
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200914 if (!urb->unlinked) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100915 if (urb->status == -EINPROGRESS)
916 urb->status = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200917 }
918
Catalin Marinasdb8516f2010-02-02 15:31:02 +0000919 if (usb_pipein(urb->pipe) && usb_pipetype(urb->pipe) != PIPE_CONTROL) {
920 void *ptr;
921 for (ptr = urb->transfer_buffer;
922 ptr < urb->transfer_buffer + urb->transfer_buffer_length;
923 ptr += PAGE_SIZE)
924 flush_dcache_page(virt_to_page(ptr));
925 }
926
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200927 /* complete() can reenter this HCD */
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100928 usb_hcd_unlink_urb_from_ep(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200929 spin_unlock(&priv->lock);
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100930 usb_hcd_giveback_urb(hcd, urb, urb->status);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200931 spin_lock(&priv->lock);
932}
933
Arvid Brodin34537732011-04-26 21:47:37 +0200934static struct isp1760_qtd *qtd_alloc(gfp_t flags, struct urb *urb,
935 u8 packet_type)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200936{
Arvid Brodin34537732011-04-26 21:47:37 +0200937 struct isp1760_qtd *qtd;
938
939 qtd = kmem_cache_zalloc(qtd_cachep, flags);
940 if (!qtd)
941 return NULL;
942
943 INIT_LIST_HEAD(&qtd->qtd_list);
944 qtd->urb = urb;
945 qtd->packet_type = packet_type;
946
947 return qtd;
948}
949
950static void qtd_free(struct isp1760_qtd *qtd)
951{
952 WARN_ON(qtd->payload_addr);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200953 kmem_cache_free(qtd_cachep, qtd);
954}
955
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100956static struct isp1760_qtd *clean_this_qtd(struct isp1760_qtd *qtd,
957 struct isp1760_qh *qh)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200958{
959 struct isp1760_qtd *tmp_qtd;
960
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100961 if (list_is_last(&qtd->qtd_list, &qh->qtd_list))
962 tmp_qtd = NULL;
963 else
964 tmp_qtd = list_entry(qtd->qtd_list.next, struct isp1760_qtd,
965 qtd_list);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200966 list_del(&qtd->qtd_list);
Arvid Brodin34537732011-04-26 21:47:37 +0200967 qtd_free(qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200968 return tmp_qtd;
969}
970
971/*
972 * Remove this QTD from the QH list and free its memory. If this QTD
973 * isn't the last one than remove also his successor(s).
974 * Returns the QTD which is part of an new URB and should be enqueued.
975 */
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100976static struct isp1760_qtd *clean_up_qtdlist(struct isp1760_qtd *qtd,
977 struct isp1760_qh *qh)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200978{
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100979 struct urb *urb;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200980
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100981 urb = qtd->urb;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200982 do {
Arvid Brodinfd436ae2011-02-26 22:03:49 +0100983 qtd = clean_this_qtd(qtd, qh);
984 } while (qtd && (qtd->urb == urb));
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200985
986 return qtd;
987}
988
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100989static void do_atl_int(struct usb_hcd *hcd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200990{
Arvid Brodinbedc0c32011-02-26 22:02:57 +0100991 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200992 u32 done_map, skip_map;
993 struct ptd ptd;
Arvid Brodin6bda21b2011-02-26 22:06:37 +0100994 struct urb *urb;
995 u32 slot;
Sebastian Siewiordb11e472008-04-24 00:37:04 +0200996 u32 length;
997 u32 or_map;
998 u32 status = -EINVAL;
999 int error;
1000 struct isp1760_qtd *qtd;
1001 struct isp1760_qh *qh;
1002 u32 rl;
1003 u32 nakcount;
1004
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001005 done_map = reg_read32(hcd->regs, HC_ATL_PTD_DONEMAP_REG);
1006 skip_map = reg_read32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001007
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001008 or_map = reg_read32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001009 or_map &= ~done_map;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001010 reg_write32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG, or_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001011
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001012 while (done_map) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001013 status = 0;
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +01001014 priv->atl_queued--;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001015
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001016 slot = __ffs(done_map);
1017 done_map &= ~(1 << slot);
1018 skip_map |= (1 << slot);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001019
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001020 qtd = priv->atl_ints[slot].qtd;
1021 qh = priv->atl_ints[slot].qh;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001022
Arvid Brodin847ed3e2011-04-26 21:47:12 +02001023 /* urb unlinked? */
1024 if (!qh)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001025 continue;
Arvid Brodin847ed3e2011-04-26 21:47:12 +02001026
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001027 ptd_read(hcd->regs, ATL_PTD_OFFSET, slot, &ptd);
Enrico Scholz3f02a952008-07-17 20:09:30 +02001028
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001029 rl = (ptd.dw2 >> 25) & 0x0f;
1030 nakcount = (ptd.dw3 >> 19) & 0xf;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001031
1032 /* Transfer Error, *but* active and no HALT -> reload */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001033 if ((ptd.dw3 & DW3_ERROR_BIT) && (ptd.dw3 & DW3_QTD_ACTIVE) &&
1034 !(ptd.dw3 & DW3_HALT_BIT)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001035
1036 /* according to ppriv code, we have to
1037 * reload this one if trasfered bytes != requested bytes
1038 * else act like everything went smooth..
1039 * XXX This just doesn't feel right and hasn't
1040 * triggered so far.
1041 */
1042
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001043 length = PTD_XFERRED_LENGTH(ptd.dw3);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001044 dev_err(hcd->self.controller,
1045 "Should reload now... transferred %d "
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001046 "of %zu\n", length, qtd->length);
1047 BUG();
1048 }
1049
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001050 if (!nakcount && (ptd.dw3 & DW3_QTD_ACTIVE)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001051 u32 buffstatus;
1052
Colin Tuckleyc0d74142010-01-07 11:22:47 +00001053 /*
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001054 * NAKs are handled in HW by the chip. Usually if the
1055 * device is not able to send data fast enough.
Colin Tuckleyc0d74142010-01-07 11:22:47 +00001056 * This happens mostly on slower hardware.
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001057 */
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001058
1059 /* RL counter = ERR counter */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001060 ptd.dw3 &= ~(0xf << 19);
1061 ptd.dw3 |= rl << 19;
1062 ptd.dw3 &= ~(3 << (55 - 32));
1063 ptd.dw3 |= ERR_COUNTER << (55 - 32);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001064
1065 /*
1066 * It is not needed to write skip map back because it
1067 * is unchanged. Just make sure that this entry is
1068 * unskipped once it gets written to the HW.
1069 */
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001070 skip_map &= ~(1 << slot);
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001071 or_map = reg_read32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001072 or_map |= 1 << slot;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001073 reg_write32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG, or_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001074
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001075 ptd.dw0 |= PTD_VALID;
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001076 ptd_write(hcd->regs, ATL_PTD_OFFSET, slot, &ptd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001077
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +01001078 priv->atl_queued++;
1079 if (priv->atl_queued == 2)
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001080 reg_write32(hcd->regs, HC_INTERRUPT_ENABLE,
1081 INTERRUPT_ENABLE_SOT_MASK);
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +01001082
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001083 buffstatus = reg_read32(hcd->regs,
1084 HC_BUFFER_STATUS_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001085 buffstatus |= ATL_BUFFER;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001086 reg_write32(hcd->regs, HC_BUFFER_STATUS_REG,
1087 buffstatus);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001088 continue;
1089 }
1090
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001091 error = check_error(hcd, &ptd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001092 if (error) {
1093 status = error;
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001094 priv->atl_ints[slot].qh->toggle = 0;
1095 priv->atl_ints[slot].qh->ping = 0;
1096 qtd->urb->status = -EPIPE;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001097
1098#if 0
1099 printk(KERN_ERR "Error in %s().\n", __func__);
1100 printk(KERN_ERR "IN dw0: %08x dw1: %08x dw2: %08x "
1101 "dw3: %08x dw4: %08x dw5: %08x dw6: "
1102 "%08x dw7: %08x\n",
1103 ptd.dw0, ptd.dw1, ptd.dw2, ptd.dw3,
1104 ptd.dw4, ptd.dw5, ptd.dw6, ptd.dw7);
1105#endif
1106 } else {
Arvid Brodin7adc14b12011-02-26 22:08:47 +01001107 priv->atl_ints[slot].qh->toggle = ptd.dw3 & (1 << 25);
1108 priv->atl_ints[slot].qh->ping = ptd.dw3 & (1 << 26);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001109 }
1110
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001111 length = PTD_XFERRED_LENGTH(ptd.dw3);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001112 if (length) {
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001113 switch (DW1_GET_PID(ptd.dw1)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001114 case IN_PID:
Arvid Brodina041d8e2011-02-26 22:04:40 +01001115 mem_reads8(hcd->regs, qtd->payload_addr,
Arvid Brodinbbaa3872011-02-26 22:05:26 +01001116 qtd->data_buffer, length);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001117
1118 case OUT_PID:
1119
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001120 qtd->urb->actual_length += length;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001121
1122 case SETUP_PID:
1123 break;
1124 }
1125 }
1126
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001127 priv->atl_ints[slot].qtd = NULL;
1128 priv->atl_ints[slot].qh = NULL;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001129
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001130 free_mem(hcd, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001131
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001132 reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, skip_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001133
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001134 if (qtd->urb->status == -EPIPE) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001135 /* HALT was received */
1136
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001137 urb = qtd->urb;
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001138 qtd = clean_up_qtdlist(qtd, qh);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001139 isp1760_urb_done(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001140
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001141 } else if (usb_pipebulk(qtd->urb->pipe) &&
1142 (length < qtd->length)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001143 /* short BULK received */
1144
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001145 if (qtd->urb->transfer_flags & URB_SHORT_NOT_OK) {
1146 qtd->urb->status = -EREMOTEIO;
1147 dev_dbg(hcd->self.controller,
1148 "short bulk, %d instead %zu "
1149 "with URB_SHORT_NOT_OK flag.\n",
1150 length, qtd->length);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001151 }
1152
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001153 if (qtd->urb->status == -EINPROGRESS)
1154 qtd->urb->status = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001155
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001156 urb = qtd->urb;
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001157 qtd = clean_up_qtdlist(qtd, qh);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001158 isp1760_urb_done(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001159
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001160 } else if (last_qtd_of_urb(qtd, qh)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001161 /* that was the last qtd of that URB */
1162
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001163 if (qtd->urb->status == -EINPROGRESS)
1164 qtd->urb->status = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001165
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001166 urb = qtd->urb;
1167 qtd = clean_up_qtdlist(qtd, qh);
1168 isp1760_urb_done(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001169
1170 } else {
1171 /* next QTD of this URB */
1172
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001173 qtd = clean_this_qtd(qtd, qh);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001174 BUG_ON(!qtd);
1175 }
1176
1177 if (qtd)
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001178 enqueue_an_ATL_packet(hcd, qh, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001179
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001180 skip_map = reg_read32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001181 }
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +01001182 if (priv->atl_queued <= 1)
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001183 reg_write32(hcd->regs, HC_INTERRUPT_ENABLE,
1184 INTERRUPT_ENABLE_MASK);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001185}
1186
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001187static void do_intl_int(struct usb_hcd *hcd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001188{
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001189 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001190 u32 done_map, skip_map;
1191 struct ptd ptd;
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001192 struct urb *urb;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001193 u32 length;
1194 u32 or_map;
1195 int error;
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001196 u32 slot;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001197 struct isp1760_qtd *qtd;
1198 struct isp1760_qh *qh;
1199
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001200 done_map = reg_read32(hcd->regs, HC_INT_PTD_DONEMAP_REG);
1201 skip_map = reg_read32(hcd->regs, HC_INT_PTD_SKIPMAP_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001202
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001203 or_map = reg_read32(hcd->regs, HC_INT_IRQ_MASK_OR_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001204 or_map &= ~done_map;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001205 reg_write32(hcd->regs, HC_INT_IRQ_MASK_OR_REG, or_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001206
1207 while (done_map) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001208 slot = __ffs(done_map);
1209 done_map &= ~(1 << slot);
1210 skip_map |= (1 << slot);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001211
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001212 qtd = priv->int_ints[slot].qtd;
1213 qh = priv->int_ints[slot].qh;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001214
Arvid Brodin847ed3e2011-04-26 21:47:12 +02001215 /* urb unlinked? */
1216 if (!qh)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001217 continue;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001218
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001219 ptd_read(hcd->regs, INT_PTD_OFFSET, slot, &ptd);
1220 check_int_err_status(hcd, ptd.dw4);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001221
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001222 error = check_error(hcd, &ptd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001223 if (error) {
1224#if 0
1225 printk(KERN_ERR "Error in %s().\n", __func__);
1226 printk(KERN_ERR "IN dw0: %08x dw1: %08x dw2: %08x "
1227 "dw3: %08x dw4: %08x dw5: %08x dw6: "
1228 "%08x dw7: %08x\n",
1229 ptd.dw0, ptd.dw1, ptd.dw2, ptd.dw3,
1230 ptd.dw4, ptd.dw5, ptd.dw6, ptd.dw7);
1231#endif
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001232 qtd->urb->status = -EPIPE;
1233 priv->int_ints[slot].qh->toggle = 0;
1234 priv->int_ints[slot].qh->ping = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001235
1236 } else {
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001237 priv->int_ints[slot].qh->toggle = ptd.dw3 & (1 << 25);
1238 priv->int_ints[slot].qh->ping = ptd.dw3 & (1 << 26);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001239 }
1240
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001241 if (qtd->urb->dev->speed != USB_SPEED_HIGH)
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001242 length = PTD_XFERRED_LENGTH_LO(ptd.dw3);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001243 else
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001244 length = PTD_XFERRED_LENGTH(ptd.dw3);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001245
1246 if (length) {
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001247 switch (DW1_GET_PID(ptd.dw1)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001248 case IN_PID:
Arvid Brodina041d8e2011-02-26 22:04:40 +01001249 mem_reads8(hcd->regs, qtd->payload_addr,
Arvid Brodinbbaa3872011-02-26 22:05:26 +01001250 qtd->data_buffer, length);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001251 case OUT_PID:
1252
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001253 qtd->urb->actual_length += length;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001254
1255 case SETUP_PID:
1256 break;
1257 }
1258 }
1259
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001260 priv->int_ints[slot].qtd = NULL;
1261 priv->int_ints[slot].qh = NULL;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001262
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001263 reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, skip_map);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001264 free_mem(hcd, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001265
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001266 if (qtd->urb->status == -EPIPE) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001267 /* HALT received */
1268
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001269 urb = qtd->urb;
1270 qtd = clean_up_qtdlist(qtd, qh);
1271 isp1760_urb_done(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001272
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001273 } else if (last_qtd_of_urb(qtd, qh)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001274
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001275 if (qtd->urb->status == -EINPROGRESS)
1276 qtd->urb->status = 0;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001277
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001278 urb = qtd->urb;
1279 qtd = clean_up_qtdlist(qtd, qh);
1280 isp1760_urb_done(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001281
1282 } else {
1283 /* next QTD of this URB */
1284
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001285 qtd = clean_this_qtd(qtd, qh);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001286 BUG_ON(!qtd);
1287 }
1288
1289 if (qtd)
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001290 enqueue_an_INT_packet(hcd, qh, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001291
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001292 skip_map = reg_read32(hcd->regs, HC_INT_PTD_SKIPMAP_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001293 }
1294}
1295
Arvid Brodin34537732011-04-26 21:47:37 +02001296static int qtd_fill(struct isp1760_qtd *qtd, void *databuffer, size_t len)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001297{
Arvid Brodin34537732011-04-26 21:47:37 +02001298 qtd->data_buffer = databuffer;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001299
Arvid Brodin34537732011-04-26 21:47:37 +02001300 if (len > MAX_PAYLOAD_SIZE)
1301 len = MAX_PAYLOAD_SIZE;
1302 qtd->length = len;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001303
Arvid Brodin34537732011-04-26 21:47:37 +02001304 return qtd->length;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001305}
1306
Arvid Brodin34537732011-04-26 21:47:37 +02001307static void qtd_list_free(struct list_head *qtd_list)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001308{
Arvid Brodin34537732011-04-26 21:47:37 +02001309 struct isp1760_qtd *qtd, *qtd_next;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001310
Arvid Brodin34537732011-04-26 21:47:37 +02001311 list_for_each_entry_safe(qtd, qtd_next, qtd_list, qtd_list) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001312 list_del(&qtd->qtd_list);
Arvid Brodin34537732011-04-26 21:47:37 +02001313 qtd_free(qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001314 }
1315}
1316
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001317/*
Arvid Brodin34537732011-04-26 21:47:37 +02001318 * Packetize urb->transfer_buffer into list of packets of size wMaxPacketSize.
1319 * Also calculate the PID type (SETUP/IN/OUT) for each packet.
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001320 */
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001321#define max_packet(wMaxPacketSize) ((wMaxPacketSize) & 0x07ff)
Arvid Brodin34537732011-04-26 21:47:37 +02001322static void packetize_urb(struct usb_hcd *hcd,
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001323 struct urb *urb, struct list_head *head, gfp_t flags)
1324{
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001325 struct isp1760_qtd *qtd;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001326 void *buf;
Arvid Brodin34537732011-04-26 21:47:37 +02001327 int len, maxpacketsize;
1328 u8 packet_type;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001329
1330 /*
1331 * URBs map to sequences of QTDs: one logical transaction
1332 */
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001333
Arvid Brodin34537732011-04-26 21:47:37 +02001334 if (!urb->transfer_buffer && urb->transfer_buffer_length) {
1335 /* XXX This looks like usb storage / SCSI bug */
1336 dev_err(hcd->self.controller,
1337 "buf is null, dma is %08lx len is %d\n",
1338 (long unsigned)urb->transfer_dma,
1339 urb->transfer_buffer_length);
1340 WARN_ON(1);
1341 }
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001342
Arvid Brodin34537732011-04-26 21:47:37 +02001343 if (usb_pipein(urb->pipe))
1344 packet_type = IN_PID;
1345 else
1346 packet_type = OUT_PID;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001347
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001348 if (usb_pipecontrol(urb->pipe)) {
Arvid Brodin34537732011-04-26 21:47:37 +02001349 qtd = qtd_alloc(flags, urb, SETUP_PID);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001350 if (!qtd)
1351 goto cleanup;
Arvid Brodin34537732011-04-26 21:47:37 +02001352 qtd_fill(qtd, urb->setup_packet, sizeof(struct usb_ctrlrequest));
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001353 list_add_tail(&qtd->qtd_list, head);
1354
1355 /* for zero length DATA stages, STATUS is always IN */
Arvid Brodin34537732011-04-26 21:47:37 +02001356 if (urb->transfer_buffer_length == 0)
1357 packet_type = IN_PID;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001358 }
1359
Arvid Brodin34537732011-04-26 21:47:37 +02001360 maxpacketsize = max_packet(usb_maxpacket(urb->dev, urb->pipe,
1361 usb_pipeout(urb->pipe)));
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001362
1363 /*
1364 * buffer gets wrapped in one or more qtds;
1365 * last one may be "short" (including zero len)
1366 * and may serve as a control status ack
1367 */
Arvid Brodin34537732011-04-26 21:47:37 +02001368 buf = urb->transfer_buffer;
1369 len = urb->transfer_buffer_length;
1370
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001371 for (;;) {
1372 int this_qtd_len;
1373
Arvid Brodin34537732011-04-26 21:47:37 +02001374 qtd = qtd_alloc(flags, urb, packet_type);
1375 if (!qtd)
1376 goto cleanup;
1377 this_qtd_len = qtd_fill(qtd, buf, len);
1378 list_add_tail(&qtd->qtd_list, head);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001379
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001380 len -= this_qtd_len;
1381 buf += this_qtd_len;
1382
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001383 if (len <= 0)
1384 break;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001385 }
1386
1387 /*
1388 * control requests may need a terminating data "status" ack;
1389 * bulk ones may need a terminating short packet (zero length).
1390 */
1391 if (urb->transfer_buffer_length != 0) {
1392 int one_more = 0;
1393
1394 if (usb_pipecontrol(urb->pipe)) {
1395 one_more = 1;
Arvid Brodin34537732011-04-26 21:47:37 +02001396 if (packet_type == IN_PID)
1397 packet_type = OUT_PID;
1398 else
1399 packet_type = IN_PID;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001400 } else if (usb_pipebulk(urb->pipe)
1401 && (urb->transfer_flags & URB_ZERO_PACKET)
Arvid Brodin34537732011-04-26 21:47:37 +02001402 && !(urb->transfer_buffer_length %
1403 maxpacketsize)) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001404 one_more = 1;
1405 }
1406 if (one_more) {
Arvid Brodin34537732011-04-26 21:47:37 +02001407 qtd = qtd_alloc(flags, urb, packet_type);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001408 if (!qtd)
1409 goto cleanup;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001410
1411 /* never any data in such packets */
Arvid Brodin34537732011-04-26 21:47:37 +02001412 qtd_fill(qtd, NULL, 0);
1413 list_add_tail(&qtd->qtd_list, head);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001414 }
1415 }
1416
Arvid Brodin34537732011-04-26 21:47:37 +02001417 return;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001418
1419cleanup:
Arvid Brodin34537732011-04-26 21:47:37 +02001420 qtd_list_free(head);
1421}
1422
1423static int enqueue_qtdlist(struct usb_hcd *hcd, struct urb *urb,
1424 struct list_head *qtd_list, gfp_t mem_flags, packet_enqueue *p)
1425{
1426 struct isp1760_hcd *priv = hcd_to_priv(hcd);
1427 struct isp1760_qtd *qtd;
1428 struct isp1760_qh *qh = NULL;
1429 unsigned long flags;
1430 int qh_empty;
1431 int rc;
1432
1433 spin_lock_irqsave(&priv->lock, flags);
1434 if (!HCD_HW_ACCESSIBLE(hcd)) {
1435 rc = -ESHUTDOWN;
1436 goto done;
1437 }
1438 rc = usb_hcd_link_urb_to_ep(hcd, urb);
1439 if (rc)
1440 goto done;
1441
1442 qh = urb->ep->hcpriv;
1443 if (!qh) {
1444 qh = isp1760_qh_alloc(GFP_ATOMIC);
1445 if (!qh) {
1446 usb_hcd_unlink_urb_from_ep(hcd, urb);
1447 rc = -ENOMEM;
1448 goto done;
1449 }
1450 if (!usb_pipecontrol(urb->pipe))
1451 usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe),
1452 !usb_pipein(urb->pipe), 1);
1453 urb->ep->hcpriv = qh;
1454 }
1455
1456 qh_empty = list_empty(&qh->qtd_list);
1457 list_splice_tail(qtd_list, &qh->qtd_list);
1458 if (qh_empty) {
1459 qtd = list_entry(qtd_list->next, struct isp1760_qtd, qtd_list);
1460 p(hcd, qh, qtd);
1461 }
1462
1463done:
1464 spin_unlock_irqrestore(&priv->lock, flags);
1465 if (!qh)
1466 qtd_list_free(qtd_list);
1467 return rc;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001468}
1469
1470static int isp1760_urb_enqueue(struct usb_hcd *hcd, struct urb *urb,
1471 gfp_t mem_flags)
1472{
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001473 struct list_head qtd_list;
1474 packet_enqueue *pe;
1475
1476 INIT_LIST_HEAD(&qtd_list);
1477
1478 switch (usb_pipetype(urb->pipe)) {
1479 case PIPE_CONTROL:
1480 case PIPE_BULK:
Arvid Brodin34537732011-04-26 21:47:37 +02001481 pe = enqueue_an_ATL_packet;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001482 break;
1483
1484 case PIPE_INTERRUPT:
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001485 pe = enqueue_an_INT_packet;
1486 break;
1487
1488 case PIPE_ISOCHRONOUS:
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001489 dev_err(hcd->self.controller, "PIPE_ISOCHRONOUS ain't supported\n");
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001490 default:
1491 return -EPIPE;
1492 }
1493
Arvid Brodin34537732011-04-26 21:47:37 +02001494 packetize_urb(hcd, urb, &qtd_list, mem_flags);
1495 if (list_empty(&qtd_list))
1496 return -ENOMEM;
1497
1498 return enqueue_qtdlist(hcd, urb, &qtd_list, mem_flags, pe);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001499}
1500
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001501static int isp1760_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001502{
1503 struct isp1760_hcd *priv = hcd_to_priv(hcd);
1504 struct inter_packet_info *ints;
1505 u32 i;
1506 u32 reg_base, or_reg, skip_reg;
Andrew Mortond249afd2008-06-09 16:39:52 -07001507 unsigned long flags;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001508 struct ptd ptd;
Warren Free0afb20e2009-05-08 10:27:08 +02001509 packet_enqueue *pe;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001510
1511 switch (usb_pipetype(urb->pipe)) {
1512 case PIPE_ISOCHRONOUS:
1513 return -EPIPE;
1514 break;
1515
1516 case PIPE_INTERRUPT:
1517 ints = priv->int_ints;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001518 reg_base = INT_PTD_OFFSET;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001519 or_reg = HC_INT_IRQ_MASK_OR_REG;
1520 skip_reg = HC_INT_PTD_SKIPMAP_REG;
Warren Free0afb20e2009-05-08 10:27:08 +02001521 pe = enqueue_an_INT_packet;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001522 break;
1523
1524 default:
1525 ints = priv->atl_ints;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001526 reg_base = ATL_PTD_OFFSET;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001527 or_reg = HC_ATL_IRQ_MASK_OR_REG;
1528 skip_reg = HC_ATL_PTD_SKIPMAP_REG;
Warren Free0afb20e2009-05-08 10:27:08 +02001529 pe = enqueue_an_ATL_packet;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001530 break;
1531 }
1532
1533 memset(&ptd, 0, sizeof(ptd));
1534 spin_lock_irqsave(&priv->lock, flags);
1535
1536 for (i = 0; i < 32; i++) {
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001537 if (!ints[i].qh)
1538 continue;
Arvid Brodin34537732011-04-26 21:47:37 +02001539 WARN_ON(!ints[i].qtd);
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001540
1541 if (ints[i].qtd->urb == urb) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001542 u32 skip_map;
1543 u32 or_map;
1544 struct isp1760_qtd *qtd;
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001545 struct isp1760_qh *qh;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001546
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001547 skip_map = reg_read32(hcd->regs, skip_reg);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001548 skip_map |= 1 << i;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001549 reg_write32(hcd->regs, skip_reg, skip_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001550
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001551 or_map = reg_read32(hcd->regs, or_reg);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001552 or_map &= ~(1 << i);
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001553 reg_write32(hcd->regs, or_reg, or_map);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001554
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001555 ptd_write(hcd->regs, reg_base, i, &ptd);
1556
Arvid Brodind3cf2a82011-03-07 15:36:21 +01001557 qtd = ints[i].qtd;
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001558 qh = ints[i].qh;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001559
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001560 free_mem(hcd, qtd);
Arvid Brodina041d8e2011-02-26 22:04:40 +01001561 qtd = clean_up_qtdlist(qtd, qh);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001562
Arvid Brodind3cf2a82011-03-07 15:36:21 +01001563 ints[i].qh = NULL;
1564 ints[i].qtd = NULL;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001565
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001566 isp1760_urb_done(hcd, urb);
Warren Free0afb20e2009-05-08 10:27:08 +02001567 if (qtd)
1568 pe(hcd, qh, qtd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001569 break;
Warren Free0afb20e2009-05-08 10:27:08 +02001570
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001571 } else {
1572 struct isp1760_qtd *qtd;
Warren Free0afb20e2009-05-08 10:27:08 +02001573
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001574 list_for_each_entry(qtd, &ints[i].qtd->qtd_list,
1575 qtd_list) {
Warren Free0afb20e2009-05-08 10:27:08 +02001576 if (qtd->urb == urb) {
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001577 clean_up_qtdlist(qtd, ints[i].qh);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001578 isp1760_urb_done(hcd, urb);
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001579 qtd = NULL;
Warren Free0afb20e2009-05-08 10:27:08 +02001580 break;
1581 }
Warren Free0afb20e2009-05-08 10:27:08 +02001582 }
Arvid Brodinfd436ae2011-02-26 22:03:49 +01001583
1584 /* We found the urb before the last slot */
1585 if (!qtd)
Warren Free0afb20e2009-05-08 10:27:08 +02001586 break;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001587 }
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001588 }
1589
1590 spin_unlock_irqrestore(&priv->lock, flags);
1591 return 0;
1592}
1593
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001594static irqreturn_t isp1760_irq(struct usb_hcd *hcd)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001595{
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001596 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001597 u32 imask;
1598 irqreturn_t irqret = IRQ_NONE;
1599
1600 spin_lock(&priv->lock);
1601
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001602 if (!(hcd->state & HC_STATE_RUNNING))
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001603 goto leave;
1604
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001605 imask = reg_read32(hcd->regs, HC_INTERRUPT_REG);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001606 if (unlikely(!imask))
1607 goto leave;
1608
Greg Kroah-Hartman753d8532011-04-14 13:37:07 -07001609 reg_write32(hcd->regs, HC_INTERRUPT_REG, imask);
Sebastian Andrzej Siewiorb14e8402011-02-08 21:07:40 +01001610 if (imask & (HC_ATL_INT | HC_SOT_INT))
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001611 do_atl_int(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001612
1613 if (imask & HC_INTL_INT)
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001614 do_intl_int(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001615
1616 irqret = IRQ_HANDLED;
1617leave:
1618 spin_unlock(&priv->lock);
1619 return irqret;
1620}
1621
1622static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf)
1623{
1624 struct isp1760_hcd *priv = hcd_to_priv(hcd);
1625 u32 temp, status = 0;
1626 u32 mask;
1627 int retval = 1;
1628 unsigned long flags;
1629
1630 /* if !USB_SUSPEND, root hub timers won't get shut down ... */
1631 if (!HC_IS_RUNNING(hcd->state))
1632 return 0;
1633
1634 /* init status to no-changes */
1635 buf[0] = 0;
1636 mask = PORT_CSC;
1637
1638 spin_lock_irqsave(&priv->lock, flags);
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001639 temp = reg_read32(hcd->regs, HC_PORTSC1);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001640
1641 if (temp & PORT_OWNER) {
1642 if (temp & PORT_CSC) {
1643 temp &= ~PORT_CSC;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001644 reg_write32(hcd->regs, HC_PORTSC1, temp);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001645 goto done;
1646 }
1647 }
1648
1649 /*
1650 * Return status information even for ports with OWNER set.
1651 * Otherwise khubd wouldn't see the disconnect event when a
1652 * high-speed device is switched over to the companion
1653 * controller by the user.
1654 */
1655
1656 if ((temp & mask) != 0
1657 || ((temp & PORT_RESUME) != 0
1658 && time_after_eq(jiffies,
1659 priv->reset_done))) {
1660 buf [0] |= 1 << (0 + 1);
1661 status = STS_PCD;
1662 }
1663 /* FIXME autosuspend idle root hubs */
1664done:
1665 spin_unlock_irqrestore(&priv->lock, flags);
1666 return status ? retval : 0;
1667}
1668
1669static void isp1760_hub_descriptor(struct isp1760_hcd *priv,
1670 struct usb_hub_descriptor *desc)
1671{
1672 int ports = HCS_N_PORTS(priv->hcs_params);
1673 u16 temp;
1674
1675 desc->bDescriptorType = 0x29;
1676 /* priv 1.0, 2.3.9 says 20ms max */
1677 desc->bPwrOn2PwrGood = 10;
1678 desc->bHubContrCurrent = 0;
1679
1680 desc->bNbrPorts = ports;
1681 temp = 1 + (ports / 8);
1682 desc->bDescLength = 7 + 2 * temp;
1683
Sarah Sharpda130512010-11-30 15:55:51 -08001684 /* ports removable, and usb 1.0 legacy PortPwrCtrlMask */
John Youndbe79bb2001-09-17 00:00:00 -07001685 memset(&desc->u.hs.DeviceRemovable[0], 0, temp);
1686 memset(&desc->u.hs.DeviceRemovable[temp], 0xff, temp);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001687
1688 /* per-port overcurrent reporting */
1689 temp = 0x0008;
1690 if (HCS_PPC(priv->hcs_params))
1691 /* per-port power control */
1692 temp |= 0x0001;
1693 else
1694 /* no power switching */
1695 temp |= 0x0002;
1696 desc->wHubCharacteristics = cpu_to_le16(temp);
1697}
1698
1699#define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
1700
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001701static int check_reset_complete(struct usb_hcd *hcd, int index,
1702 int port_status)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001703{
1704 if (!(port_status & PORT_CONNECT))
1705 return port_status;
1706
1707 /* if reset finished and it's still not enabled -- handoff */
1708 if (!(port_status & PORT_PE)) {
1709
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001710 dev_err(hcd->self.controller,
1711 "port %d full speed --> companion\n",
1712 index + 1);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001713
1714 port_status |= PORT_OWNER;
1715 port_status &= ~PORT_RWC_BITS;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001716 reg_write32(hcd->regs, HC_PORTSC1, port_status);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001717
1718 } else
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001719 dev_err(hcd->self.controller, "port %d high speed\n",
1720 index + 1);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001721
1722 return port_status;
1723}
1724
1725static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
1726 u16 wValue, u16 wIndex, char *buf, u16 wLength)
1727{
1728 struct isp1760_hcd *priv = hcd_to_priv(hcd);
1729 int ports = HCS_N_PORTS(priv->hcs_params);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001730 u32 temp, status;
1731 unsigned long flags;
1732 int retval = 0;
1733 unsigned selector;
1734
1735 /*
1736 * FIXME: support SetPortFeatures USB_PORT_FEAT_INDICATOR.
1737 * HCS_INDICATOR may say we can change LEDs to off/amber/green.
1738 * (track current state ourselves) ... blink for diagnostics,
1739 * power, "this is the one", etc. EHCI spec supports this.
1740 */
1741
1742 spin_lock_irqsave(&priv->lock, flags);
1743 switch (typeReq) {
1744 case ClearHubFeature:
1745 switch (wValue) {
1746 case C_HUB_LOCAL_POWER:
1747 case C_HUB_OVER_CURRENT:
1748 /* no hub-wide feature/status flags */
1749 break;
1750 default:
1751 goto error;
1752 }
1753 break;
1754 case ClearPortFeature:
1755 if (!wIndex || wIndex > ports)
1756 goto error;
1757 wIndex--;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001758 temp = reg_read32(hcd->regs, HC_PORTSC1);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001759
1760 /*
1761 * Even if OWNER is set, so the port is owned by the
1762 * companion controller, khubd needs to be able to clear
1763 * the port-change status bits (especially
Alan Stern749da5f2010-03-04 17:05:08 -05001764 * USB_PORT_STAT_C_CONNECTION).
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001765 */
1766
1767 switch (wValue) {
1768 case USB_PORT_FEAT_ENABLE:
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001769 reg_write32(hcd->regs, HC_PORTSC1, temp & ~PORT_PE);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001770 break;
1771 case USB_PORT_FEAT_C_ENABLE:
1772 /* XXX error? */
1773 break;
1774 case USB_PORT_FEAT_SUSPEND:
1775 if (temp & PORT_RESET)
1776 goto error;
1777
1778 if (temp & PORT_SUSPEND) {
1779 if ((temp & PORT_PE) == 0)
1780 goto error;
1781 /* resume signaling for 20 msec */
1782 temp &= ~(PORT_RWC_BITS);
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001783 reg_write32(hcd->regs, HC_PORTSC1,
1784 temp | PORT_RESUME);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001785 priv->reset_done = jiffies +
1786 msecs_to_jiffies(20);
1787 }
1788 break;
1789 case USB_PORT_FEAT_C_SUSPEND:
1790 /* we auto-clear this feature */
1791 break;
1792 case USB_PORT_FEAT_POWER:
1793 if (HCS_PPC(priv->hcs_params))
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001794 reg_write32(hcd->regs, HC_PORTSC1,
1795 temp & ~PORT_POWER);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001796 break;
1797 case USB_PORT_FEAT_C_CONNECTION:
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001798 reg_write32(hcd->regs, HC_PORTSC1, temp | PORT_CSC);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001799 break;
1800 case USB_PORT_FEAT_C_OVER_CURRENT:
1801 /* XXX error ?*/
1802 break;
1803 case USB_PORT_FEAT_C_RESET:
1804 /* GetPortStatus clears reset */
1805 break;
1806 default:
1807 goto error;
1808 }
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001809 reg_read32(hcd->regs, HC_USBCMD);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001810 break;
1811 case GetHubDescriptor:
1812 isp1760_hub_descriptor(priv, (struct usb_hub_descriptor *)
1813 buf);
1814 break;
1815 case GetHubStatus:
1816 /* no hub-wide feature/status flags */
1817 memset(buf, 0, 4);
1818 break;
1819 case GetPortStatus:
1820 if (!wIndex || wIndex > ports)
1821 goto error;
1822 wIndex--;
1823 status = 0;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001824 temp = reg_read32(hcd->regs, HC_PORTSC1);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001825
1826 /* wPortChange bits */
1827 if (temp & PORT_CSC)
Alan Stern749da5f2010-03-04 17:05:08 -05001828 status |= USB_PORT_STAT_C_CONNECTION << 16;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001829
1830
1831 /* whoever resumes must GetPortStatus to complete it!! */
1832 if (temp & PORT_RESUME) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001833 dev_err(hcd->self.controller, "Port resume should be skipped.\n");
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001834
1835 /* Remote Wakeup received? */
1836 if (!priv->reset_done) {
1837 /* resume signaling for 20 msec */
1838 priv->reset_done = jiffies
1839 + msecs_to_jiffies(20);
1840 /* check the port again */
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001841 mod_timer(&hcd->rh_timer, priv->reset_done);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001842 }
1843
1844 /* resume completed? */
1845 else if (time_after_eq(jiffies,
1846 priv->reset_done)) {
Alan Stern749da5f2010-03-04 17:05:08 -05001847 status |= USB_PORT_STAT_C_SUSPEND << 16;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001848 priv->reset_done = 0;
1849
1850 /* stop resume signaling */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001851 temp = reg_read32(hcd->regs, HC_PORTSC1);
1852 reg_write32(hcd->regs, HC_PORTSC1,
1853 temp & ~(PORT_RWC_BITS | PORT_RESUME));
1854 retval = handshake(hcd, HC_PORTSC1,
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001855 PORT_RESUME, 0, 2000 /* 2msec */);
1856 if (retval != 0) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001857 dev_err(hcd->self.controller,
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001858 "port %d resume error %d\n",
1859 wIndex + 1, retval);
1860 goto error;
1861 }
1862 temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));
1863 }
1864 }
1865
1866 /* whoever resets must GetPortStatus to complete it!! */
1867 if ((temp & PORT_RESET)
1868 && time_after_eq(jiffies,
1869 priv->reset_done)) {
Alan Stern749da5f2010-03-04 17:05:08 -05001870 status |= USB_PORT_STAT_C_RESET << 16;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001871 priv->reset_done = 0;
1872
1873 /* force reset to complete */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001874 reg_write32(hcd->regs, HC_PORTSC1, temp & ~PORT_RESET);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001875 /* REVISIT: some hardware needs 550+ usec to clear
1876 * this bit; seems too long to spin routinely...
1877 */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001878 retval = handshake(hcd, HC_PORTSC1,
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001879 PORT_RESET, 0, 750);
1880 if (retval != 0) {
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001881 dev_err(hcd->self.controller, "port %d reset error %d\n",
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001882 wIndex + 1, retval);
1883 goto error;
1884 }
1885
1886 /* see what we found out */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001887 temp = check_reset_complete(hcd, wIndex,
1888 reg_read32(hcd->regs, HC_PORTSC1));
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001889 }
1890 /*
1891 * Even if OWNER is set, there's no harm letting khubd
1892 * see the wPortStatus values (they should all be 0 except
1893 * for PORT_POWER anyway).
1894 */
1895
1896 if (temp & PORT_OWNER)
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001897 dev_err(hcd->self.controller, "PORT_OWNER is set\n");
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001898
1899 if (temp & PORT_CONNECT) {
Alan Stern749da5f2010-03-04 17:05:08 -05001900 status |= USB_PORT_STAT_CONNECTION;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001901 /* status may be from integrated TT */
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001902 status |= USB_PORT_STAT_HIGH_SPEED;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001903 }
1904 if (temp & PORT_PE)
Alan Stern749da5f2010-03-04 17:05:08 -05001905 status |= USB_PORT_STAT_ENABLE;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001906 if (temp & (PORT_SUSPEND|PORT_RESUME))
Alan Stern749da5f2010-03-04 17:05:08 -05001907 status |= USB_PORT_STAT_SUSPEND;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001908 if (temp & PORT_RESET)
Alan Stern749da5f2010-03-04 17:05:08 -05001909 status |= USB_PORT_STAT_RESET;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001910 if (temp & PORT_POWER)
Alan Stern749da5f2010-03-04 17:05:08 -05001911 status |= USB_PORT_STAT_POWER;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001912
1913 put_unaligned(cpu_to_le32(status), (__le32 *) buf);
1914 break;
1915 case SetHubFeature:
1916 switch (wValue) {
1917 case C_HUB_LOCAL_POWER:
1918 case C_HUB_OVER_CURRENT:
1919 /* no hub-wide feature/status flags */
1920 break;
1921 default:
1922 goto error;
1923 }
1924 break;
1925 case SetPortFeature:
1926 selector = wIndex >> 8;
1927 wIndex &= 0xff;
1928 if (!wIndex || wIndex > ports)
1929 goto error;
1930 wIndex--;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001931 temp = reg_read32(hcd->regs, HC_PORTSC1);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001932 if (temp & PORT_OWNER)
1933 break;
1934
1935/* temp &= ~PORT_RWC_BITS; */
1936 switch (wValue) {
1937 case USB_PORT_FEAT_ENABLE:
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001938 reg_write32(hcd->regs, HC_PORTSC1, temp | PORT_PE);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001939 break;
1940
1941 case USB_PORT_FEAT_SUSPEND:
1942 if ((temp & PORT_PE) == 0
1943 || (temp & PORT_RESET) != 0)
1944 goto error;
1945
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001946 reg_write32(hcd->regs, HC_PORTSC1, temp | PORT_SUSPEND);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001947 break;
1948 case USB_PORT_FEAT_POWER:
1949 if (HCS_PPC(priv->hcs_params))
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001950 reg_write32(hcd->regs, HC_PORTSC1,
1951 temp | PORT_POWER);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001952 break;
1953 case USB_PORT_FEAT_RESET:
1954 if (temp & PORT_RESUME)
1955 goto error;
1956 /* line status bits may report this as low speed,
1957 * which can be fine if this root hub has a
1958 * transaction translator built in.
1959 */
1960 if ((temp & (PORT_PE|PORT_CONNECT)) == PORT_CONNECT
1961 && PORT_USB11(temp)) {
1962 temp |= PORT_OWNER;
1963 } else {
1964 temp |= PORT_RESET;
1965 temp &= ~PORT_PE;
1966
1967 /*
1968 * caller must wait, then call GetPortStatus
1969 * usb 2.0 spec says 50 ms resets on root
1970 */
1971 priv->reset_done = jiffies +
1972 msecs_to_jiffies(50);
1973 }
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001974 reg_write32(hcd->regs, HC_PORTSC1, temp);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001975 break;
1976 default:
1977 goto error;
1978 }
Arvid Brodinbedc0c32011-02-26 22:02:57 +01001979 reg_read32(hcd->regs, HC_USBCMD);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001980 break;
1981
1982 default:
1983error:
1984 /* "stall" on error */
1985 retval = -EPIPE;
1986 }
1987 spin_unlock_irqrestore(&priv->lock, flags);
1988 return retval;
1989}
1990
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001991static void isp1760_endpoint_disable(struct usb_hcd *hcd,
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001992 struct usb_host_endpoint *ep)
1993{
Arvid Brodin6bda21b2011-02-26 22:06:37 +01001994 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001995 struct isp1760_qh *qh;
1996 struct isp1760_qtd *qtd;
Andrew Mortond249afd2008-06-09 16:39:52 -07001997 unsigned long flags;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02001998
1999 spin_lock_irqsave(&priv->lock, flags);
2000 qh = ep->hcpriv;
2001 if (!qh)
2002 goto out;
2003
2004 ep->hcpriv = NULL;
2005 do {
2006 /* more than entry might get removed */
2007 if (list_empty(&qh->qtd_list))
2008 break;
2009
2010 qtd = list_first_entry(&qh->qtd_list, struct isp1760_qtd,
2011 qtd_list);
2012
2013 if (qtd->status & URB_ENQUEUED) {
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002014 spin_unlock_irqrestore(&priv->lock, flags);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01002015 isp1760_urb_dequeue(hcd, qtd->urb, -ECONNRESET);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002016 spin_lock_irqsave(&priv->lock, flags);
2017 } else {
2018 struct urb *urb;
2019
2020 urb = qtd->urb;
Arvid Brodinfd436ae2011-02-26 22:03:49 +01002021 clean_up_qtdlist(qtd, qh);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01002022 urb->status = -ECONNRESET;
2023 isp1760_urb_done(hcd, urb);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002024 }
2025 } while (1);
2026
2027 qh_destroy(qh);
2028 /* remove requests and leak them.
2029 * ATL are pretty fast done, INT could take a while...
2030 * The latter shoule be removed
2031 */
2032out:
2033 spin_unlock_irqrestore(&priv->lock, flags);
2034}
2035
2036static int isp1760_get_frame(struct usb_hcd *hcd)
2037{
2038 struct isp1760_hcd *priv = hcd_to_priv(hcd);
2039 u32 fr;
2040
Arvid Brodinbedc0c32011-02-26 22:02:57 +01002041 fr = reg_read32(hcd->regs, HC_FRINDEX);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002042 return (fr >> 3) % priv->periodic_size;
2043}
2044
2045static void isp1760_stop(struct usb_hcd *hcd)
2046{
2047 struct isp1760_hcd *priv = hcd_to_priv(hcd);
Nate Case3faefc82008-06-17 11:11:38 -05002048 u32 temp;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002049
2050 isp1760_hub_control(hcd, ClearPortFeature, USB_PORT_FEAT_POWER, 1,
2051 NULL, 0);
2052 mdelay(20);
2053
2054 spin_lock_irq(&priv->lock);
Arvid Brodin6bda21b2011-02-26 22:06:37 +01002055 ehci_reset(hcd);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002056 /* Disable IRQ */
Arvid Brodinbedc0c32011-02-26 22:02:57 +01002057 temp = reg_read32(hcd->regs, HC_HW_MODE_CTRL);
2058 reg_write32(hcd->regs, HC_HW_MODE_CTRL, temp &= ~HW_GLOBAL_INTR_EN);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002059 spin_unlock_irq(&priv->lock);
2060
Arvid Brodinbedc0c32011-02-26 22:02:57 +01002061 reg_write32(hcd->regs, HC_CONFIGFLAG, 0);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002062}
2063
2064static void isp1760_shutdown(struct usb_hcd *hcd)
2065{
Nate Case3faefc82008-06-17 11:11:38 -05002066 u32 command, temp;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002067
2068 isp1760_stop(hcd);
Arvid Brodinbedc0c32011-02-26 22:02:57 +01002069 temp = reg_read32(hcd->regs, HC_HW_MODE_CTRL);
2070 reg_write32(hcd->regs, HC_HW_MODE_CTRL, temp &= ~HW_GLOBAL_INTR_EN);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002071
Arvid Brodinbedc0c32011-02-26 22:02:57 +01002072 command = reg_read32(hcd->regs, HC_USBCMD);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002073 command &= ~CMD_RUN;
Arvid Brodinbedc0c32011-02-26 22:02:57 +01002074 reg_write32(hcd->regs, HC_USBCMD, command);
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002075}
2076
2077static const struct hc_driver isp1760_hc_driver = {
2078 .description = "isp1760-hcd",
2079 .product_desc = "NXP ISP1760 USB Host Controller",
2080 .hcd_priv_size = sizeof(struct isp1760_hcd),
2081 .irq = isp1760_irq,
2082 .flags = HCD_MEMORY | HCD_USB2,
2083 .reset = isp1760_hc_setup,
2084 .start = isp1760_run,
2085 .stop = isp1760_stop,
2086 .shutdown = isp1760_shutdown,
2087 .urb_enqueue = isp1760_urb_enqueue,
2088 .urb_dequeue = isp1760_urb_dequeue,
2089 .endpoint_disable = isp1760_endpoint_disable,
2090 .get_frame_number = isp1760_get_frame,
2091 .hub_status_data = isp1760_hub_status_data,
2092 .hub_control = isp1760_hub_control,
2093};
2094
2095int __init init_kmem_once(void)
2096{
2097 qtd_cachep = kmem_cache_create("isp1760_qtd",
2098 sizeof(struct isp1760_qtd), 0, SLAB_TEMPORARY |
2099 SLAB_MEM_SPREAD, NULL);
2100
2101 if (!qtd_cachep)
2102 return -ENOMEM;
2103
2104 qh_cachep = kmem_cache_create("isp1760_qh", sizeof(struct isp1760_qh),
2105 0, SLAB_TEMPORARY | SLAB_MEM_SPREAD, NULL);
2106
2107 if (!qh_cachep) {
2108 kmem_cache_destroy(qtd_cachep);
2109 return -ENOMEM;
2110 }
2111
2112 return 0;
2113}
2114
2115void deinit_kmem_cache(void)
2116{
2117 kmem_cache_destroy(qtd_cachep);
2118 kmem_cache_destroy(qh_cachep);
2119}
2120
Catalin Marinasf9031f22009-02-10 16:55:45 +00002121struct usb_hcd *isp1760_register(phys_addr_t res_start, resource_size_t res_len,
2122 int irq, unsigned long irqflags,
2123 struct device *dev, const char *busname,
2124 unsigned int devflags)
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002125{
2126 struct usb_hcd *hcd;
2127 struct isp1760_hcd *priv;
2128 int ret;
2129
2130 if (usb_disabled())
2131 return ERR_PTR(-ENODEV);
2132
2133 /* prevent usb-core allocating DMA pages */
2134 dev->dma_mask = NULL;
2135
Kay Sievers0031a062008-05-02 06:02:41 +02002136 hcd = usb_create_hcd(&isp1760_hc_driver, dev, dev_name(dev));
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002137 if (!hcd)
2138 return ERR_PTR(-ENOMEM);
2139
2140 priv = hcd_to_priv(hcd);
Nate Case3faefc82008-06-17 11:11:38 -05002141 priv->devflags = devflags;
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002142 init_memory(priv);
2143 hcd->regs = ioremap(res_start, res_len);
2144 if (!hcd->regs) {
2145 ret = -EIO;
2146 goto err_put;
2147 }
2148
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002149 hcd->irq = irq;
2150 hcd->rsrc_start = res_start;
2151 hcd->rsrc_len = res_len;
2152
Nate Casee6942d62008-05-21 16:28:20 -05002153 ret = usb_add_hcd(hcd, irq, irqflags);
2154 if (ret)
2155 goto err_unmap;
2156
Sebastian Siewiordb11e472008-04-24 00:37:04 +02002157 return hcd;
2158
2159err_unmap:
2160 iounmap(hcd->regs);
2161
2162err_put:
2163 usb_put_hcd(hcd);
2164
2165 return ERR_PTR(ret);
2166}
2167
2168MODULE_DESCRIPTION("Driver for the ISP1760 USB-controller from NXP");
2169MODULE_AUTHOR("Sebastian Siewior <bigeasy@linuxtronix.de>");
2170MODULE_LICENSE("GPL v2");