?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
USB: m66592-udc: fixes some problems
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / usb / gadget / m66592-udc.c
blob700dda8a91579666cf04af70416e2dae6fb01912
1 /*
2 * M66592 UDC (USB gadget)
3 *
4 * Copyright (C) 2006-2007 Renesas Solutions Corp.
5 *
6 * Author : Yoshihiro Shimoda <shimoda.yoshihiro@renesas.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2 of the License.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 *
21 */
22
23 #include <linux/module.h>
24 #include <linux/interrupt.h>
25 #include <linux/delay.h>
26 #include <linux/io.h>
27 #include <linux/platform_device.h>
28
29 #include <linux/usb/ch9.h>
30 #include <linux/usb_gadget.h>
31
32 #include "m66592-udc.h"
33
34
35 MODULE_DESCRIPTION("M66592 USB gadget driver");
36 MODULE_LICENSE("GPL");
37 MODULE_AUTHOR("Yoshihiro Shimoda");
38
39 #define DRIVER_VERSION "29 May 2007"
40
41 /* module parameters */
42 static unsigned short clock = M66592_XTAL24;
43 module_param(clock, ushort, 0644);
44 MODULE_PARM_DESC(clock, "input clock: 48MHz=32768, 24MHz=16384, 12MHz=0 "
45 "(default=16384)");
46
47 static unsigned short vif = M66592_LDRV;
48 module_param(vif, ushort, 0644);
49 MODULE_PARM_DESC(vif, "input VIF: 3.3V=32768, 1.5V=0 (default=32768)");
50
51 static unsigned short endian;
52 module_param(endian, ushort, 0644);
53 MODULE_PARM_DESC(endian, "data endian: big=256, little=0 (default=0)");
54
55 static unsigned short irq_sense = M66592_INTL;
56 module_param(irq_sense, ushort, 0644);
57 MODULE_PARM_DESC(irq_sense, "IRQ sense: low level=2, falling edge=0 "
58 "(default=2)");
59
60 static const char udc_name[] = "m66592_udc";
61 static const char *m66592_ep_name[] = {
62 "ep0", "ep1", "ep2", "ep3", "ep4", "ep5", "ep6", "ep7"
63 };
64
65 static void disable_controller(struct m66592 *m66592);
66 static void irq_ep0_write(struct m66592_ep *ep, struct m66592_request *req);
67 static void irq_packet_write(struct m66592_ep *ep, struct m66592_request *req);
68 static int m66592_queue(struct usb_ep *_ep, struct usb_request *_req,
69 gfp_t gfp_flags);
70
71 static void transfer_complete(struct m66592_ep *ep,
72 struct m66592_request *req, int status);
73
74 /*-------------------------------------------------------------------------*/
75 static inline u16 get_usb_speed(struct m66592 *m66592)
76 {
77 return (m66592_read(m66592, M66592_DVSTCTR) & M66592_RHST);
78 }
79
80 static void enable_pipe_irq(struct m66592 *m66592, u16 pipenum,
81 unsigned long reg)
82 {
83 u16 tmp;
84
85 tmp = m66592_read(m66592, M66592_INTENB0);
86 m66592_bclr(m66592, M66592_BEMPE | M66592_NRDYE | M66592_BRDYE,
87 M66592_INTENB0);
88 m66592_bset(m66592, (1 << pipenum), reg);
89 m66592_write(m66592, tmp, M66592_INTENB0);
90 }
91
92 static void disable_pipe_irq(struct m66592 *m66592, u16 pipenum,
93 unsigned long reg)
94 {
95 u16 tmp;
96
97 tmp = m66592_read(m66592, M66592_INTENB0);
98 m66592_bclr(m66592, M66592_BEMPE | M66592_NRDYE | M66592_BRDYE,
99 M66592_INTENB0);
100 m66592_bclr(m66592, (1 << pipenum), reg);
101 m66592_write(m66592, tmp, M66592_INTENB0);
102 }
103
104 static void m66592_usb_connect(struct m66592 *m66592)
105 {
106 m66592_bset(m66592, M66592_CTRE, M66592_INTENB0);
107 m66592_bset(m66592, M66592_WDST | M66592_RDST | M66592_CMPL,
108 M66592_INTENB0);
109 m66592_bset(m66592, M66592_BEMPE | M66592_BRDYE, M66592_INTENB0);
110
111 m66592_bset(m66592, M66592_DPRPU, M66592_SYSCFG);
112 }
113
114 static void m66592_usb_disconnect(struct m66592 *m66592)
115 __releases(m66592->lock)
116 __acquires(m66592->lock)
117 {
118 m66592_bclr(m66592, M66592_CTRE, M66592_INTENB0);
119 m66592_bclr(m66592, M66592_WDST | M66592_RDST | M66592_CMPL,
120 M66592_INTENB0);
121 m66592_bclr(m66592, M66592_BEMPE | M66592_BRDYE, M66592_INTENB0);
122 m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
123
124 m66592->gadget.speed = USB_SPEED_UNKNOWN;
125 spin_unlock(&m66592->lock);
126 m66592->driver->disconnect(&m66592->gadget);
127 spin_lock(&m66592->lock);
128
129 disable_controller(m66592);
130 INIT_LIST_HEAD(&m66592->ep[0].queue);
131 }
132
133 static inline u16 control_reg_get_pid(struct m66592 *m66592, u16 pipenum)
134 {
135 u16 pid = 0;
136 unsigned long offset;
137
138 if (pipenum == 0)
139 pid = m66592_read(m66592, M66592_DCPCTR) & M66592_PID;
140 else if (pipenum < M66592_MAX_NUM_PIPE) {
141 offset = get_pipectr_addr(pipenum);
142 pid = m66592_read(m66592, offset) & M66592_PID;
143 } else
144 printk(KERN_ERR "unexpect pipe num (%d)\n", pipenum);
145
146 return pid;
147 }
148
149 static inline void control_reg_set_pid(struct m66592 *m66592, u16 pipenum,
150 u16 pid)
151 {
152 unsigned long offset;
153
154 if (pipenum == 0)
155 m66592_mdfy(m66592, pid, M66592_PID, M66592_DCPCTR);
156 else if (pipenum < M66592_MAX_NUM_PIPE) {
157 offset = get_pipectr_addr(pipenum);
158 m66592_mdfy(m66592, pid, M66592_PID, offset);
159 } else
160 printk(KERN_ERR "unexpect pipe num (%d)\n", pipenum);
161 }
162
163 static inline void pipe_start(struct m66592 *m66592, u16 pipenum)
164 {
165 control_reg_set_pid(m66592, pipenum, M66592_PID_BUF);
166 }
167
168 static inline void pipe_stop(struct m66592 *m66592, u16 pipenum)
169 {
170 control_reg_set_pid(m66592, pipenum, M66592_PID_NAK);
171 }
172
173 static inline void pipe_stall(struct m66592 *m66592, u16 pipenum)
174 {
175 control_reg_set_pid(m66592, pipenum, M66592_PID_STALL);
176 }
177
178 static inline u16 control_reg_get(struct m66592 *m66592, u16 pipenum)
179 {
180 u16 ret = 0;
181 unsigned long offset;
182
183 if (pipenum == 0)
184 ret = m66592_read(m66592, M66592_DCPCTR);
185 else if (pipenum < M66592_MAX_NUM_PIPE) {
186 offset = get_pipectr_addr(pipenum);
187 ret = m66592_read(m66592, offset);
188 } else
189 printk(KERN_ERR "unexpect pipe num (%d)\n", pipenum);
190
191 return ret;
192 }
193
194 static inline void control_reg_sqclr(struct m66592 *m66592, u16 pipenum)
195 {
196 unsigned long offset;
197
198 pipe_stop(m66592, pipenum);
199
200 if (pipenum == 0)
201 m66592_bset(m66592, M66592_SQCLR, M66592_DCPCTR);
202 else if (pipenum < M66592_MAX_NUM_PIPE) {
203 offset = get_pipectr_addr(pipenum);
204 m66592_bset(m66592, M66592_SQCLR, offset);
205 } else
206 printk(KERN_ERR "unexpect pipe num(%d)\n", pipenum);
207 }
208
209 static inline int get_buffer_size(struct m66592 *m66592, u16 pipenum)
210 {
211 u16 tmp;
212 int size;
213
214 if (pipenum == 0) {
215 tmp = m66592_read(m66592, M66592_DCPCFG);
216 if ((tmp & M66592_CNTMD) != 0)
217 size = 256;
218 else {
219 tmp = m66592_read(m66592, M66592_DCPMAXP);
220 size = tmp & M66592_MAXP;
221 }
222 } else {
223 m66592_write(m66592, pipenum, M66592_PIPESEL);
224 tmp = m66592_read(m66592, M66592_PIPECFG);
225 if ((tmp & M66592_CNTMD) != 0) {
226 tmp = m66592_read(m66592, M66592_PIPEBUF);
227 size = ((tmp >> 10) + 1) * 64;
228 } else {
229 tmp = m66592_read(m66592, M66592_PIPEMAXP);
230 size = tmp & M66592_MXPS;
231 }
232 }
233
234 return size;
235 }
236
237 static inline void pipe_change(struct m66592 *m66592, u16 pipenum)
238 {
239 struct m66592_ep *ep = m66592->pipenum2ep[pipenum];
240
241 if (ep->use_dma)
242 return;
243
244 m66592_mdfy(m66592, pipenum, M66592_CURPIPE, ep->fifosel);
245
246 ndelay(450);
247
248 m66592_bset(m66592, M66592_MBW, ep->fifosel);
249 }
250
251 static int pipe_buffer_setting(struct m66592 *m66592,
252 struct m66592_pipe_info *info)
253 {
254 u16 bufnum = 0, buf_bsize = 0;
255 u16 pipecfg = 0;
256
257 if (info->pipe == 0)
258 return -EINVAL;
259
260 m66592_write(m66592, info->pipe, M66592_PIPESEL);
261
262 if (info->dir_in)
263 pipecfg |= M66592_DIR;
264 pipecfg |= info->type;
265 pipecfg |= info->epnum;
266 switch (info->type) {
267 case M66592_INT:
268 bufnum = 4 + (info->pipe - M66592_BASE_PIPENUM_INT);
269 buf_bsize = 0;
270 break;
271 case M66592_BULK:
272 bufnum = m66592->bi_bufnum +
273 (info->pipe - M66592_BASE_PIPENUM_BULK) * 16;
274 m66592->bi_bufnum += 16;
275 buf_bsize = 7;
276 pipecfg |= M66592_DBLB;
277 if (!info->dir_in)
278 pipecfg |= M66592_SHTNAK;
279 break;
280 case M66592_ISO:
281 bufnum = m66592->bi_bufnum +
282 (info->pipe - M66592_BASE_PIPENUM_ISOC) * 16;
283 m66592->bi_bufnum += 16;
284 buf_bsize = 7;
285 break;
286 }
287 if (m66592->bi_bufnum > M66592_MAX_BUFNUM) {
288 printk(KERN_ERR "m66592 pipe memory is insufficient(%d)\n",
289 m66592->bi_bufnum);
290 return -ENOMEM;
291 }
292
293 m66592_write(m66592, pipecfg, M66592_PIPECFG);
294 m66592_write(m66592, (buf_bsize << 10) | (bufnum), M66592_PIPEBUF);
295 m66592_write(m66592, info->maxpacket, M66592_PIPEMAXP);
296 if (info->interval)
297 info->interval--;
298 m66592_write(m66592, info->interval, M66592_PIPEPERI);
299
300 return 0;
301 }
302
303 static void pipe_buffer_release(struct m66592 *m66592,
304 struct m66592_pipe_info *info)
305 {
306 if (info->pipe == 0)
307 return;
308
309 switch (info->type) {
310 case M66592_BULK:
311 if (is_bulk_pipe(info->pipe))
312 m66592->bi_bufnum -= 16;
313 break;
314 case M66592_ISO:
315 if (is_isoc_pipe(info->pipe))
316 m66592->bi_bufnum -= 16;
317 break;
318 }
319
320 if (is_bulk_pipe(info->pipe)) {
321 m66592->bulk--;
322 } else if (is_interrupt_pipe(info->pipe))
323 m66592->interrupt--;
324 else if (is_isoc_pipe(info->pipe)) {
325 m66592->isochronous--;
326 if (info->type == M66592_BULK)
327 m66592->bulk--;
328 } else
329 printk(KERN_ERR "ep_release: unexpect pipenum (%d)\n",
330 info->pipe);
331 }
332
333 static void pipe_initialize(struct m66592_ep *ep)
334 {
335 struct m66592 *m66592 = ep->m66592;
336
337 m66592_mdfy(m66592, 0, M66592_CURPIPE, ep->fifosel);
338
339 m66592_write(m66592, M66592_ACLRM, ep->pipectr);
340 m66592_write(m66592, 0, ep->pipectr);
341 m66592_write(m66592, M66592_SQCLR, ep->pipectr);
342 if (ep->use_dma) {
343 m66592_mdfy(m66592, ep->pipenum, M66592_CURPIPE, ep->fifosel);
344
345 ndelay(450);
346
347 m66592_bset(m66592, M66592_MBW, ep->fifosel);
348 }
349 }
350
351 static void m66592_ep_setting(struct m66592 *m66592, struct m66592_ep *ep,
352 const struct usb_endpoint_descriptor *desc,
353 u16 pipenum, int dma)
354 {
355 if ((pipenum != 0) && dma) {
356 if (m66592->num_dma == 0) {
357 m66592->num_dma++;
358 ep->use_dma = 1;
359 ep->fifoaddr = M66592_D0FIFO;
360 ep->fifosel = M66592_D0FIFOSEL;
361 ep->fifoctr = M66592_D0FIFOCTR;
362 ep->fifotrn = M66592_D0FIFOTRN;
363 } else if (m66592->num_dma == 1) {
364 m66592->num_dma++;
365 ep->use_dma = 1;
366 ep->fifoaddr = M66592_D1FIFO;
367 ep->fifosel = M66592_D1FIFOSEL;
368 ep->fifoctr = M66592_D1FIFOCTR;
369 ep->fifotrn = M66592_D1FIFOTRN;
370 } else {
371 ep->use_dma = 0;
372 ep->fifoaddr = M66592_CFIFO;
373 ep->fifosel = M66592_CFIFOSEL;
374 ep->fifoctr = M66592_CFIFOCTR;
375 ep->fifotrn = 0;
376 }
377 } else {
378 ep->use_dma = 0;
379 ep->fifoaddr = M66592_CFIFO;
380 ep->fifosel = M66592_CFIFOSEL;
381 ep->fifoctr = M66592_CFIFOCTR;
382 ep->fifotrn = 0;
383 }
384
385 ep->pipectr = get_pipectr_addr(pipenum);
386 ep->pipenum = pipenum;
387 ep->ep.maxpacket = le16_to_cpu(desc->wMaxPacketSize);
388 m66592->pipenum2ep[pipenum] = ep;
389 m66592->epaddr2ep[desc->bEndpointAddress&USB_ENDPOINT_NUMBER_MASK] = ep;
390 INIT_LIST_HEAD(&ep->queue);
391 }
392
393 static void m66592_ep_release(struct m66592_ep *ep)
394 {
395 struct m66592 *m66592 = ep->m66592;
396 u16 pipenum = ep->pipenum;
397
398 if (pipenum == 0)
399 return;
400
401 if (ep->use_dma)
402 m66592->num_dma--;
403 ep->pipenum = 0;
404 ep->busy = 0;
405 ep->use_dma = 0;
406 }
407
408 static int alloc_pipe_config(struct m66592_ep *ep,
409 const struct usb_endpoint_descriptor *desc)
410 {
411 struct m66592 *m66592 = ep->m66592;
412 struct m66592_pipe_info info;
413 int dma = 0;
414 int *counter;
415 int ret;
416
417 ep->desc = desc;
418
419 BUG_ON(ep->pipenum);
420
421 switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
422 case USB_ENDPOINT_XFER_BULK:
423 if (m66592->bulk >= M66592_MAX_NUM_BULK) {
424 if (m66592->isochronous >= M66592_MAX_NUM_ISOC) {
425 printk(KERN_ERR "bulk pipe is insufficient\n");
426 return -ENODEV;
427 } else {
428 info.pipe = M66592_BASE_PIPENUM_ISOC
429 + m66592->isochronous;
430 counter = &m66592->isochronous;
431 }
432 } else {
433 info.pipe = M66592_BASE_PIPENUM_BULK + m66592->bulk;
434 counter = &m66592->bulk;
435 }
436 info.type = M66592_BULK;
437 dma = 1;
438 break;
439 case USB_ENDPOINT_XFER_INT:
440 if (m66592->interrupt >= M66592_MAX_NUM_INT) {
441 printk(KERN_ERR "interrupt pipe is insufficient\n");
442 return -ENODEV;
443 }
444 info.pipe = M66592_BASE_PIPENUM_INT + m66592->interrupt;
445 info.type = M66592_INT;
446 counter = &m66592->interrupt;
447 break;
448 case USB_ENDPOINT_XFER_ISOC:
449 if (m66592->isochronous >= M66592_MAX_NUM_ISOC) {
450 printk(KERN_ERR "isochronous pipe is insufficient\n");
451 return -ENODEV;
452 }
453 info.pipe = M66592_BASE_PIPENUM_ISOC + m66592->isochronous;
454 info.type = M66592_ISO;
455 counter = &m66592->isochronous;
456 break;
457 default:
458 printk(KERN_ERR "unexpect xfer type\n");
459 return -EINVAL;
460 }
461 ep->type = info.type;
462
463 info.epnum = desc->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK;
464 info.maxpacket = le16_to_cpu(desc->wMaxPacketSize);
465 info.interval = desc->bInterval;
466 if (desc->bEndpointAddress & USB_ENDPOINT_DIR_MASK)
467 info.dir_in = 1;
468 else
469 info.dir_in = 0;
470
471 ret = pipe_buffer_setting(m66592, &info);
472 if (ret < 0) {
473 printk(KERN_ERR "pipe_buffer_setting fail\n");
474 return ret;
475 }
476
477 (*counter)++;
478 if ((counter == &m66592->isochronous) && info.type == M66592_BULK)
479 m66592->bulk++;
480
481 m66592_ep_setting(m66592, ep, desc, info.pipe, dma);
482 pipe_initialize(ep);
483
484 return 0;
485 }
486
487 static int free_pipe_config(struct m66592_ep *ep)
488 {
489 struct m66592 *m66592 = ep->m66592;
490 struct m66592_pipe_info info;
491
492 info.pipe = ep->pipenum;
493 info.type = ep->type;
494 pipe_buffer_release(m66592, &info);
495 m66592_ep_release(ep);
496
497 return 0;
498 }
499
500 /*-------------------------------------------------------------------------*/
501 static void pipe_irq_enable(struct m66592 *m66592, u16 pipenum)
502 {
503 enable_irq_ready(m66592, pipenum);
504 enable_irq_nrdy(m66592, pipenum);
505 }
506
507 static void pipe_irq_disable(struct m66592 *m66592, u16 pipenum)
508 {
509 disable_irq_ready(m66592, pipenum);
510 disable_irq_nrdy(m66592, pipenum);
511 }
512
513 /* if complete is true, gadget driver complete function is not call */
514 static void control_end(struct m66592 *m66592, unsigned ccpl)
515 {
516 m66592->ep[0].internal_ccpl = ccpl;
517 pipe_start(m66592, 0);
518 m66592_bset(m66592, M66592_CCPL, M66592_DCPCTR);
519 }
520
521 static void start_ep0_write(struct m66592_ep *ep, struct m66592_request *req)
522 {
523 struct m66592 *m66592 = ep->m66592;
524
525 pipe_change(m66592, ep->pipenum);
526 m66592_mdfy(m66592, M66592_ISEL | M66592_PIPE0,
527 (M66592_ISEL | M66592_CURPIPE),
528 M66592_CFIFOSEL);
529 m66592_write(m66592, M66592_BCLR, ep->fifoctr);
530 if (req->req.length == 0) {
531 m66592_bset(m66592, M66592_BVAL, ep->fifoctr);
532 pipe_start(m66592, 0);
533 transfer_complete(ep, req, 0);
534 } else {
535 m66592_write(m66592, ~M66592_BEMP0, M66592_BEMPSTS);
536 irq_ep0_write(ep, req);
537 }
538 }
539
540 static void start_packet_write(struct m66592_ep *ep, struct m66592_request *req)
541 {
542 struct m66592 *m66592 = ep->m66592;
543 u16 tmp;
544
545 pipe_change(m66592, ep->pipenum);
546 disable_irq_empty(m66592, ep->pipenum);
547 pipe_start(m66592, ep->pipenum);
548
549 tmp = m66592_read(m66592, ep->fifoctr);
550 if (unlikely((tmp & M66592_FRDY) == 0))
551 pipe_irq_enable(m66592, ep->pipenum);
552 else
553 irq_packet_write(ep, req);
554 }
555
556 static void start_packet_read(struct m66592_ep *ep, struct m66592_request *req)
557 {
558 struct m66592 *m66592 = ep->m66592;
559 u16 pipenum = ep->pipenum;
560
561 if (ep->pipenum == 0) {
562 m66592_mdfy(m66592, M66592_PIPE0,
563 (M66592_ISEL | M66592_CURPIPE),
564 M66592_CFIFOSEL);
565 m66592_write(m66592, M66592_BCLR, ep->fifoctr);
566 pipe_start(m66592, pipenum);
567 pipe_irq_enable(m66592, pipenum);
568 } else {
569 if (ep->use_dma) {
570 m66592_bset(m66592, M66592_TRCLR, ep->fifosel);
571 pipe_change(m66592, pipenum);
572 m66592_bset(m66592, M66592_TRENB, ep->fifosel);
573 m66592_write(m66592,
574 (req->req.length + ep->ep.maxpacket - 1)
575 / ep->ep.maxpacket,
576 ep->fifotrn);
577 }
578 pipe_start(m66592, pipenum); /* trigger once */
579 pipe_irq_enable(m66592, pipenum);
580 }
581 }
582
583 static void start_packet(struct m66592_ep *ep, struct m66592_request *req)
584 {
585 if (ep->desc->bEndpointAddress & USB_DIR_IN)
586 start_packet_write(ep, req);
587 else
588 start_packet_read(ep, req);
589 }
590
591 static void start_ep0(struct m66592_ep *ep, struct m66592_request *req)
592 {
593 u16 ctsq;
594
595 ctsq = m66592_read(ep->m66592, M66592_INTSTS0) & M66592_CTSQ;
596
597 switch (ctsq) {
598 case M66592_CS_RDDS:
599 start_ep0_write(ep, req);
600 break;
601 case M66592_CS_WRDS:
602 start_packet_read(ep, req);
603 break;
604
605 case M66592_CS_WRND:
606 control_end(ep->m66592, 0);
607 break;
608 default:
609 printk(KERN_ERR "start_ep0: unexpect ctsq(%x)\n", ctsq);
610 break;
611 }
612 }
613
614 static void init_controller(struct m66592 *m66592)
615 {
616 m66592_bset(m66592, (vif & M66592_LDRV) | (endian & M66592_BIGEND),
617 M66592_PINCFG);
618 m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */
619 m66592_mdfy(m66592, clock & M66592_XTAL, M66592_XTAL, M66592_SYSCFG);
620
621 m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG);
622 m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
623 m66592_bset(m66592, M66592_USBE, M66592_SYSCFG);
624
625 m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG);
626
627 msleep(3);
628
629 m66592_bset(m66592, M66592_RCKE | M66592_PLLC, M66592_SYSCFG);
630
631 msleep(1);
632
633 m66592_bset(m66592, M66592_SCKE, M66592_SYSCFG);
634
635 m66592_bset(m66592, irq_sense & M66592_INTL, M66592_INTENB1);
636 m66592_write(m66592, M66592_BURST | M66592_CPU_ADR_RD_WR,
637 M66592_DMA0CFG);
638 }
639
640 static void disable_controller(struct m66592 *m66592)
641 {
642 m66592_bclr(m66592, M66592_SCKE, M66592_SYSCFG);
643 udelay(1);
644 m66592_bclr(m66592, M66592_PLLC, M66592_SYSCFG);
645 udelay(1);
646 m66592_bclr(m66592, M66592_RCKE, M66592_SYSCFG);
647 udelay(1);
648 m66592_bclr(m66592, M66592_XCKE, M66592_SYSCFG);
649 }
650
651 static void m66592_start_xclock(struct m66592 *m66592)
652 {
653 u16 tmp;
654
655 tmp = m66592_read(m66592, M66592_SYSCFG);
656 if (!(tmp & M66592_XCKE))
657 m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG);
658 }
659
660 /*-------------------------------------------------------------------------*/
661 static void transfer_complete(struct m66592_ep *ep,
662 struct m66592_request *req, int status)
663 __releases(m66592->lock)
664 __acquires(m66592->lock)
665 {
666 int restart = 0;
667
668 if (unlikely(ep->pipenum == 0)) {
669 if (ep->internal_ccpl) {
670 ep->internal_ccpl = 0;
671 return;
672 }
673 }
674
675 list_del_init(&req->queue);
676 if (ep->m66592->gadget.speed == USB_SPEED_UNKNOWN)
677 req->req.status = -ESHUTDOWN;
678 else
679 req->req.status = status;
680
681 if (!list_empty(&ep->queue))
682 restart = 1;
683
684 spin_unlock(&ep->m66592->lock);
685 req->req.complete(&ep->ep, &req->req);
686 spin_lock(&ep->m66592->lock);
687
688 if (restart) {
689 req = list_entry(ep->queue.next, struct m66592_request, queue);
690 if (ep->desc)
691 start_packet(ep, req);
692 }
693 }
694
695 static void irq_ep0_write(struct m66592_ep *ep, struct m66592_request *req)
696 {
697 int i;
698 u16 tmp;
699 unsigned bufsize;
700 size_t size;
701 void *buf;
702 u16 pipenum = ep->pipenum;
703 struct m66592 *m66592 = ep->m66592;
704
705 pipe_change(m66592, pipenum);
706 m66592_bset(m66592, M66592_ISEL, ep->fifosel);
707
708 i = 0;
709 do {
710 tmp = m66592_read(m66592, ep->fifoctr);
711 if (i++ > 100000) {
712 printk(KERN_ERR "pipe0 is busy. maybe cpu i/o bus"
713 "conflict. please power off this controller.");
714 return;
715 }
716 ndelay(1);
717 } while ((tmp & M66592_FRDY) == 0);
718
719 /* prepare parameters */
720 bufsize = get_buffer_size(m66592, pipenum);
721 buf = req->req.buf + req->req.actual;
722 size = min(bufsize, req->req.length - req->req.actual);
723
724 /* write fifo */
725 if (req->req.buf) {
726 if (size > 0)
727 m66592_write_fifo(m66592, ep->fifoaddr, buf, size);
728 if ((size == 0) || ((size % ep->ep.maxpacket) != 0))
729 m66592_bset(m66592, M66592_BVAL, ep->fifoctr);
730 }
731
732 /* update parameters */
733 req->req.actual += size;
734
735 /* check transfer finish */
736 if ((!req->req.zero && (req->req.actual == req->req.length))
737 || (size % ep->ep.maxpacket)
738 || (size == 0)) {
739 disable_irq_ready(m66592, pipenum);
740 disable_irq_empty(m66592, pipenum);
741 } else {
742 disable_irq_ready(m66592, pipenum);
743 enable_irq_empty(m66592, pipenum);
744 }
745 pipe_start(m66592, pipenum);
746 }
747
748 static void irq_packet_write(struct m66592_ep *ep, struct m66592_request *req)
749 {
750 u16 tmp;
751 unsigned bufsize;
752 size_t size;
753 void *buf;
754 u16 pipenum = ep->pipenum;
755 struct m66592 *m66592 = ep->m66592;
756
757 pipe_change(m66592, pipenum);
758 tmp = m66592_read(m66592, ep->fifoctr);
759 if (unlikely((tmp & M66592_FRDY) == 0)) {
760 pipe_stop(m66592, pipenum);
761 pipe_irq_disable(m66592, pipenum);
762 printk(KERN_ERR "write fifo not ready. pipnum=%d\n", pipenum);
763 return;
764 }
765
766 /* prepare parameters */
767 bufsize = get_buffer_size(m66592, pipenum);
768 buf = req->req.buf + req->req.actual;
769 size = min(bufsize, req->req.length - req->req.actual);
770
771 /* write fifo */
772 if (req->req.buf) {
773 m66592_write_fifo(m66592, ep->fifoaddr, buf, size);
774 if ((size == 0)
775 || ((size % ep->ep.maxpacket) != 0)
776 || ((bufsize != ep->ep.maxpacket)
777 && (bufsize > size)))
778 m66592_bset(m66592, M66592_BVAL, ep->fifoctr);
779 }
780
781 /* update parameters */
782 req->req.actual += size;
783 /* check transfer finish */
784 if ((!req->req.zero && (req->req.actual == req->req.length))
785 || (size % ep->ep.maxpacket)
786 || (size == 0)) {
787 disable_irq_ready(m66592, pipenum);
788 enable_irq_empty(m66592, pipenum);
789 } else {
790 disable_irq_empty(m66592, pipenum);
791 pipe_irq_enable(m66592, pipenum);
792 }
793 }
794
795 static void irq_packet_read(struct m66592_ep *ep, struct m66592_request *req)
796 {
797 u16 tmp;
798 int rcv_len, bufsize, req_len;
799 int size;
800 void *buf;
801 u16 pipenum = ep->pipenum;
802 struct m66592 *m66592 = ep->m66592;
803 int finish = 0;
804
805 pipe_change(m66592, pipenum);
806 tmp = m66592_read(m66592, ep->fifoctr);
807 if (unlikely((tmp & M66592_FRDY) == 0)) {
808 req->req.status = -EPIPE;
809 pipe_stop(m66592, pipenum);
810 pipe_irq_disable(m66592, pipenum);
811 printk(KERN_ERR "read fifo not ready");
812 return;
813 }
814
815 /* prepare parameters */
816 rcv_len = tmp & M66592_DTLN;
817 bufsize = get_buffer_size(m66592, pipenum);
818
819 buf = req->req.buf + req->req.actual;
820 req_len = req->req.length - req->req.actual;
821 if (rcv_len < bufsize)
822 size = min(rcv_len, req_len);
823 else
824 size = min(bufsize, req_len);
825
826 /* update parameters */
827 req->req.actual += size;
828
829 /* check transfer finish */
830 if ((!req->req.zero && (req->req.actual == req->req.length))
831 || (size % ep->ep.maxpacket)
832 || (size == 0)) {
833 pipe_stop(m66592, pipenum);
834 pipe_irq_disable(m66592, pipenum);
835 finish = 1;
836 }
837
838 /* read fifo */
839 if (req->req.buf) {
840 if (size == 0)
841 m66592_write(m66592, M66592_BCLR, ep->fifoctr);
842 else
843 m66592_read_fifo(m66592, ep->fifoaddr, buf, size);
844 }
845
846 if ((ep->pipenum != 0) && finish)
847 transfer_complete(ep, req, 0);
848 }
849
850 static void irq_pipe_ready(struct m66592 *m66592, u16 status, u16 enb)
851 {
852 u16 check;
853 u16 pipenum;
854 struct m66592_ep *ep;
855 struct m66592_request *req;
856
857 if ((status & M66592_BRDY0) && (enb & M66592_BRDY0)) {
858 m66592_write(m66592, ~M66592_BRDY0, M66592_BRDYSTS);
859 m66592_mdfy(m66592, M66592_PIPE0, M66592_CURPIPE,
860 M66592_CFIFOSEL);
861
862 ep = &m66592->ep[0];
863 req = list_entry(ep->queue.next, struct m66592_request, queue);
864 irq_packet_read(ep, req);
865 } else {
866 for (pipenum = 1; pipenum < M66592_MAX_NUM_PIPE; pipenum++) {
867 check = 1 << pipenum;
868 if ((status & check) && (enb & check)) {
869 m66592_write(m66592, ~check, M66592_BRDYSTS);
870 ep = m66592->pipenum2ep[pipenum];
871 req = list_entry(ep->queue.next,
872 struct m66592_request, queue);
873 if (ep->desc->bEndpointAddress & USB_DIR_IN)
874 irq_packet_write(ep, req);
875 else
876 irq_packet_read(ep, req);
877 }
878 }
879 }
880 }
881
882 static void irq_pipe_empty(struct m66592 *m66592, u16 status, u16 enb)
883 {
884 u16 tmp;
885 u16 check;
886 u16 pipenum;
887 struct m66592_ep *ep;
888 struct m66592_request *req;
889
890 if ((status & M66592_BEMP0) && (enb & M66592_BEMP0)) {
891 m66592_write(m66592, ~M66592_BEMP0, M66592_BEMPSTS);
892
893 ep = &m66592->ep[0];
894 req = list_entry(ep->queue.next, struct m66592_request, queue);
895 irq_ep0_write(ep, req);
896 } else {
897 for (pipenum = 1; pipenum < M66592_MAX_NUM_PIPE; pipenum++) {
898 check = 1 << pipenum;
899 if ((status & check) && (enb & check)) {
900 m66592_write(m66592, ~check, M66592_BEMPSTS);
901 tmp = control_reg_get(m66592, pipenum);
902 if ((tmp & M66592_INBUFM) == 0) {
903 disable_irq_empty(m66592, pipenum);
904 pipe_irq_disable(m66592, pipenum);
905 pipe_stop(m66592, pipenum);
906 ep = m66592->pipenum2ep[pipenum];
907 req = list_entry(ep->queue.next,
908 struct m66592_request,
909 queue);
910 if (!list_empty(&ep->queue))
911 transfer_complete(ep, req, 0);
912 }
913 }
914 }
915 }
916 }
917
918 static void get_status(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
919 __releases(m66592->lock)
920 __acquires(m66592->lock)
921 {
922 struct m66592_ep *ep;
923 u16 pid;
924 u16 status = 0;
925 u16 w_index = le16_to_cpu(ctrl->wIndex);
926
927 switch (ctrl->bRequestType & USB_RECIP_MASK) {
928 case USB_RECIP_DEVICE:
929 status = 1 << USB_DEVICE_SELF_POWERED;
930 break;
931 case USB_RECIP_INTERFACE:
932 status = 0;
933 break;
934 case USB_RECIP_ENDPOINT:
935 ep = m66592->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK];
936 pid = control_reg_get_pid(m66592, ep->pipenum);
937 if (pid == M66592_PID_STALL)
938 status = 1 << USB_ENDPOINT_HALT;
939 else
940 status = 0;
941 break;
942 default:
943 pipe_stall(m66592, 0);
944 return; /* exit */
945 }
946
947 m66592->ep0_data = cpu_to_le16(status);
948 m66592->ep0_req->buf = &m66592->ep0_data;
949 m66592->ep0_req->length = 2;
950 /* AV: what happens if we get called again before that gets through? */
951 spin_unlock(&m66592->lock);
952 m66592_queue(m66592->gadget.ep0, m66592->ep0_req, GFP_KERNEL);
953 spin_lock(&m66592->lock);
954 }
955
956 static void clear_feature(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
957 {
958 switch (ctrl->bRequestType & USB_RECIP_MASK) {
959 case USB_RECIP_DEVICE:
960 control_end(m66592, 1);
961 break;
962 case USB_RECIP_INTERFACE:
963 control_end(m66592, 1);
964 break;
965 case USB_RECIP_ENDPOINT: {
966 struct m66592_ep *ep;
967 struct m66592_request *req;
968 u16 w_index = le16_to_cpu(ctrl->wIndex);
969
970 ep = m66592->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK];
971 pipe_stop(m66592, ep->pipenum);
972 control_reg_sqclr(m66592, ep->pipenum);
973
974 control_end(m66592, 1);
975
976 req = list_entry(ep->queue.next,
977 struct m66592_request, queue);
978 if (ep->busy) {
979 ep->busy = 0;
980 if (list_empty(&ep->queue))
981 break;
982 start_packet(ep, req);
983 } else if (!list_empty(&ep->queue))
984 pipe_start(m66592, ep->pipenum);
985 }
986 break;
987 default:
988 pipe_stall(m66592, 0);
989 break;
990 }
991 }
992
993 static void set_feature(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
994 {
995
996 switch (ctrl->bRequestType & USB_RECIP_MASK) {
997 case USB_RECIP_DEVICE:
998 control_end(m66592, 1);
999 break;
1000 case USB_RECIP_INTERFACE:
1001 control_end(m66592, 1);
1002 break;
1003 case USB_RECIP_ENDPOINT: {
1004 struct m66592_ep *ep;
1005 u16 w_index = le16_to_cpu(ctrl->wIndex);
1006
1007 ep = m66592->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK];
1008 pipe_stall(m66592, ep->pipenum);
1009
1010 control_end(m66592, 1);
1011 }
1012 break;
1013 default:
1014 pipe_stall(m66592, 0);
1015 break;
1016 }
1017 }
1018
1019 /* if return value is true, call class driver's setup() */
1020 static int setup_packet(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
1021 {
1022 u16 *p = (u16 *)ctrl;
1023 unsigned long offset = M66592_USBREQ;
1024 int i, ret = 0;
1025
1026 /* read fifo */
1027 m66592_write(m66592, ~M66592_VALID, M66592_INTSTS0);
1028
1029 for (i = 0; i < 4; i++)
1030 p[i] = m66592_read(m66592, offset + i*2);
1031
1032 /* check request */
1033 if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
1034 switch (ctrl->bRequest) {
1035 case USB_REQ_GET_STATUS:
1036 get_status(m66592, ctrl);
1037 break;
1038 case USB_REQ_CLEAR_FEATURE:
1039 clear_feature(m66592, ctrl);
1040 break;
1041 case USB_REQ_SET_FEATURE:
1042 set_feature(m66592, ctrl);
1043 break;
1044 default:
1045 ret = 1;
1046 break;
1047 }
1048 } else
1049 ret = 1;
1050 return ret;
1051 }
1052
1053 static void m66592_update_usb_speed(struct m66592 *m66592)
1054 {
1055 u16 speed = get_usb_speed(m66592);
1056
1057 switch (speed) {
1058 case M66592_HSMODE:
1059 m66592->gadget.speed = USB_SPEED_HIGH;
1060 break;
1061 case M66592_FSMODE:
1062 m66592->gadget.speed = USB_SPEED_FULL;
1063 break;
1064 default:
1065 m66592->gadget.speed = USB_SPEED_UNKNOWN;
1066 printk(KERN_ERR "USB speed unknown\n");
1067 }
1068 }
1069
1070 static void irq_device_state(struct m66592 *m66592)
1071 {
1072 u16 dvsq;
1073
1074 dvsq = m66592_read(m66592, M66592_INTSTS0) & M66592_DVSQ;
1075 m66592_write(m66592, ~M66592_DVST, M66592_INTSTS0);
1076
1077 if (dvsq == M66592_DS_DFLT) { /* bus reset */
1078 m66592->driver->disconnect(&m66592->gadget);
1079 m66592_update_usb_speed(m66592);
1080 }
1081 if (m66592->old_dvsq == M66592_DS_CNFG && dvsq != M66592_DS_CNFG)
1082 m66592_update_usb_speed(m66592);
1083 if ((dvsq == M66592_DS_CNFG || dvsq == M66592_DS_ADDS)
1084 && m66592->gadget.speed == USB_SPEED_UNKNOWN)
1085 m66592_update_usb_speed(m66592);
1086
1087 m66592->old_dvsq = dvsq;
1088 }
1089
1090 static void irq_control_stage(struct m66592 *m66592)
1091 __releases(m66592->lock)
1092 __acquires(m66592->lock)
1093 {
1094 struct usb_ctrlrequest ctrl;
1095 u16 ctsq;
1096
1097 ctsq = m66592_read(m66592, M66592_INTSTS0) & M66592_CTSQ;
1098 m66592_write(m66592, ~M66592_CTRT, M66592_INTSTS0);
1099
1100 switch (ctsq) {
1101 case M66592_CS_IDST: {
1102 struct m66592_ep *ep;
1103 struct m66592_request *req;
1104 ep = &m66592->ep[0];
1105 req = list_entry(ep->queue.next, struct m66592_request, queue);
1106 transfer_complete(ep, req, 0);
1107 }
1108 break;
1109
1110 case M66592_CS_RDDS:
1111 case M66592_CS_WRDS:
1112 case M66592_CS_WRND:
1113 if (setup_packet(m66592, &ctrl)) {
1114 spin_unlock(&m66592->lock);
1115 if (m66592->driver->setup(&m66592->gadget, &ctrl) < 0)
1116 pipe_stall(m66592, 0);
1117 spin_lock(&m66592->lock);
1118 }
1119 break;
1120 case M66592_CS_RDSS:
1121 case M66592_CS_WRSS:
1122 control_end(m66592, 0);
1123 break;
1124 default:
1125 printk(KERN_ERR "ctrl_stage: unexpect ctsq(%x)\n", ctsq);
1126 break;
1127 }
1128 }
1129
1130 static irqreturn_t m66592_irq(int irq, void *_m66592)
1131 {
1132 struct m66592 *m66592 = _m66592;
1133 u16 intsts0;
1134 u16 intenb0;
1135 u16 brdysts, nrdysts, bempsts;
1136 u16 brdyenb, nrdyenb, bempenb;
1137 u16 savepipe;
1138 u16 mask0;
1139
1140 spin_lock(&m66592->lock);
1141
1142 intsts0 = m66592_read(m66592, M66592_INTSTS0);
1143 intenb0 = m66592_read(m66592, M66592_INTENB0);
1144
1145 savepipe = m66592_read(m66592, M66592_CFIFOSEL);
1146
1147 mask0 = intsts0 & intenb0;
1148 if (mask0) {
1149 brdysts = m66592_read(m66592, M66592_BRDYSTS);
1150 nrdysts = m66592_read(m66592, M66592_NRDYSTS);
1151 bempsts = m66592_read(m66592, M66592_BEMPSTS);
1152 brdyenb = m66592_read(m66592, M66592_BRDYENB);
1153 nrdyenb = m66592_read(m66592, M66592_NRDYENB);
1154 bempenb = m66592_read(m66592, M66592_BEMPENB);
1155
1156 if (mask0 & M66592_VBINT) {
1157 m66592_write(m66592, 0xffff & ~M66592_VBINT,
1158 M66592_INTSTS0);
1159 m66592_start_xclock(m66592);
1160
1161 /* start vbus sampling */
1162 m66592->old_vbus = m66592_read(m66592, M66592_INTSTS0)
1163 & M66592_VBSTS;
1164 m66592->scount = M66592_MAX_SAMPLING;
1165
1166 mod_timer(&m66592->timer,
1167 jiffies + msecs_to_jiffies(50));
1168 }
1169 if (intsts0 & M66592_DVSQ)
1170 irq_device_state(m66592);
1171
1172 if ((intsts0 & M66592_BRDY) && (intenb0 & M66592_BRDYE)
1173 && (brdysts & brdyenb)) {
1174 irq_pipe_ready(m66592, brdysts, brdyenb);
1175 }
1176 if ((intsts0 & M66592_BEMP) && (intenb0 & M66592_BEMPE)
1177 && (bempsts & bempenb)) {
1178 irq_pipe_empty(m66592, bempsts, bempenb);
1179 }
1180
1181 if (intsts0 & M66592_CTRT)
1182 irq_control_stage(m66592);
1183 }
1184
1185 m66592_write(m66592, savepipe, M66592_CFIFOSEL);
1186
1187 spin_unlock(&m66592->lock);
1188 return IRQ_HANDLED;
1189 }
1190
1191 static void m66592_timer(unsigned long _m66592)
1192 {
1193 struct m66592 *m66592 = (struct m66592 *)_m66592;
1194 unsigned long flags;
1195 u16 tmp;
1196
1197 spin_lock_irqsave(&m66592->lock, flags);
1198 tmp = m66592_read(m66592, M66592_SYSCFG);
1199 if (!(tmp & M66592_RCKE)) {
1200 m66592_bset(m66592, M66592_RCKE | M66592_PLLC, M66592_SYSCFG);
1201 udelay(10);
1202 m66592_bset(m66592, M66592_SCKE, M66592_SYSCFG);
1203 }
1204 if (m66592->scount > 0) {
1205 tmp = m66592_read(m66592, M66592_INTSTS0) & M66592_VBSTS;
1206 if (tmp == m66592->old_vbus) {
1207 m66592->scount--;
1208 if (m66592->scount == 0) {
1209 if (tmp == M66592_VBSTS)
1210 m66592_usb_connect(m66592);
1211 else
1212 m66592_usb_disconnect(m66592);
1213 } else {
1214 mod_timer(&m66592->timer,
1215 jiffies + msecs_to_jiffies(50));
1216 }
1217 } else {
1218 m66592->scount = M66592_MAX_SAMPLING;
1219 m66592->old_vbus = tmp;
1220 mod_timer(&m66592->timer,
1221 jiffies + msecs_to_jiffies(50));
1222 }
1223 }
1224 spin_unlock_irqrestore(&m66592->lock, flags);
1225 }
1226
1227 /*-------------------------------------------------------------------------*/
1228 static int m66592_enable(struct usb_ep *_ep,
1229 const struct usb_endpoint_descriptor *desc)
1230 {
1231 struct m66592_ep *ep;
1232
1233 ep = container_of(_ep, struct m66592_ep, ep);
1234 return alloc_pipe_config(ep, desc);
1235 }
1236
1237 static int m66592_disable(struct usb_ep *_ep)
1238 {
1239 struct m66592_ep *ep;
1240 struct m66592_request *req;
1241 unsigned long flags;
1242
1243 ep = container_of(_ep, struct m66592_ep, ep);
1244 BUG_ON(!ep);
1245
1246 while (!list_empty(&ep->queue)) {
1247 req = list_entry(ep->queue.next, struct m66592_request, queue);
1248 spin_lock_irqsave(&ep->m66592->lock, flags);
1249 transfer_complete(ep, req, -ECONNRESET);
1250 spin_unlock_irqrestore(&ep->m66592->lock, flags);
1251 }
1252
1253 pipe_irq_disable(ep->m66592, ep->pipenum);
1254 return free_pipe_config(ep);
1255 }
1256
1257 static struct usb_request *m66592_alloc_request(struct usb_ep *_ep,
1258 gfp_t gfp_flags)
1259 {
1260 struct m66592_request *req;
1261
1262 req = kzalloc(sizeof(struct m66592_request), gfp_flags);
1263 if (!req)
1264 return NULL;
1265
1266 INIT_LIST_HEAD(&req->queue);
1267
1268 return &req->req;
1269 }
1270
1271 static void m66592_free_request(struct usb_ep *_ep, struct usb_request *_req)
1272 {
1273 struct m66592_request *req;
1274
1275 req = container_of(_req, struct m66592_request, req);
1276 kfree(req);
1277 }
1278
1279 static int m66592_queue(struct usb_ep *_ep, struct usb_request *_req,
1280 gfp_t gfp_flags)
1281 {
1282 struct m66592_ep *ep;
1283 struct m66592_request *req;
1284 unsigned long flags;
1285 int request = 0;
1286
1287 ep = container_of(_ep, struct m66592_ep, ep);
1288 req = container_of(_req, struct m66592_request, req);
1289
1290 if (ep->m66592->gadget.speed == USB_SPEED_UNKNOWN)
1291 return -ESHUTDOWN;
1292
1293 spin_lock_irqsave(&ep->m66592->lock, flags);
1294
1295 if (list_empty(&ep->queue))
1296 request = 1;
1297
1298 list_add_tail(&req->queue, &ep->queue);
1299 req->req.actual = 0;
1300 req->req.status = -EINPROGRESS;
1301
1302 if (ep->desc == 0) /* control */
1303 start_ep0(ep, req);
1304 else {
1305 if (request && !ep->busy)
1306 start_packet(ep, req);
1307 }
1308
1309 spin_unlock_irqrestore(&ep->m66592->lock, flags);
1310
1311 return 0;
1312 }
1313
1314 static int m66592_dequeue(struct usb_ep *_ep, struct usb_request *_req)
1315 {
1316 struct m66592_ep *ep;
1317 struct m66592_request *req;
1318 unsigned long flags;
1319
1320 ep = container_of(_ep, struct m66592_ep, ep);
1321 req = container_of(_req, struct m66592_request, req);
1322
1323 spin_lock_irqsave(&ep->m66592->lock, flags);
1324 if (!list_empty(&ep->queue))
1325 transfer_complete(ep, req, -ECONNRESET);
1326 spin_unlock_irqrestore(&ep->m66592->lock, flags);
1327
1328 return 0;
1329 }
1330
1331 static int m66592_set_halt(struct usb_ep *_ep, int value)
1332 {
1333 struct m66592_ep *ep;
1334 struct m66592_request *req;
1335 unsigned long flags;
1336 int ret = 0;
1337
1338 ep = container_of(_ep, struct m66592_ep, ep);
1339 req = list_entry(ep->queue.next, struct m66592_request, queue);
1340
1341 spin_lock_irqsave(&ep->m66592->lock, flags);
1342 if (!list_empty(&ep->queue)) {
1343 ret = -EAGAIN;
1344 goto out;
1345 }
1346 if (value) {
1347 ep->busy = 1;
1348 pipe_stall(ep->m66592, ep->pipenum);
1349 } else {
1350 ep->busy = 0;
1351 pipe_stop(ep->m66592, ep->pipenum);
1352 }
1353
1354 out:
1355 spin_unlock_irqrestore(&ep->m66592->lock, flags);
1356 return ret;
1357 }
1358
1359 static void m66592_fifo_flush(struct usb_ep *_ep)
1360 {
1361 struct m66592_ep *ep;
1362 unsigned long flags;
1363
1364 ep = container_of(_ep, struct m66592_ep, ep);
1365 spin_lock_irqsave(&ep->m66592->lock, flags);
1366 if (list_empty(&ep->queue) && !ep->busy) {
1367 pipe_stop(ep->m66592, ep->pipenum);
1368 m66592_bclr(ep->m66592, M66592_BCLR, ep->fifoctr);
1369 }
1370 spin_unlock_irqrestore(&ep->m66592->lock, flags);
1371 }
1372
1373 static struct usb_ep_ops m66592_ep_ops = {
1374 .enable = m66592_enable,
1375 .disable = m66592_disable,
1376
1377 .alloc_request = m66592_alloc_request,
1378 .free_request = m66592_free_request,
1379
1380 .queue = m66592_queue,
1381 .dequeue = m66592_dequeue,
1382
1383 .set_halt = m66592_set_halt,
1384 .fifo_flush = m66592_fifo_flush,
1385 };
1386
1387 /*-------------------------------------------------------------------------*/
1388 static struct m66592 *the_controller;
1389
1390 int usb_gadget_register_driver(struct usb_gadget_driver *driver)
1391 {
1392 struct m66592 *m66592 = the_controller;
1393 int retval;
1394
1395 if (!driver
1396 || driver->speed != USB_SPEED_HIGH
1397 || !driver->bind
1398 || !driver->setup)
1399 return -EINVAL;
1400 if (!m66592)
1401 return -ENODEV;
1402 if (m66592->driver)
1403 return -EBUSY;
1404
1405 /* hook up the driver */
1406 driver->driver.bus = NULL;
1407 m66592->driver = driver;
1408 m66592->gadget.dev.driver = &driver->driver;
1409
1410 retval = device_add(&m66592->gadget.dev);
1411 if (retval) {
1412 printk(KERN_ERR "device_add error (%d)\n", retval);
1413 goto error;
1414 }
1415
1416 retval = driver->bind (&m66592->gadget);
1417 if (retval) {
1418 printk(KERN_ERR "bind to driver error (%d)\n", retval);
1419 device_del(&m66592->gadget.dev);
1420 goto error;
1421 }
1422
1423 m66592_bset(m66592, M66592_VBSE | M66592_URST, M66592_INTENB0);
1424 if (m66592_read(m66592, M66592_INTSTS0) & M66592_VBSTS) {
1425 m66592_start_xclock(m66592);
1426 /* start vbus sampling */
1427 m66592->old_vbus = m66592_read(m66592,
1428 M66592_INTSTS0) & M66592_VBSTS;
1429 m66592->scount = M66592_MAX_SAMPLING;
1430 mod_timer(&m66592->timer, jiffies + msecs_to_jiffies(50));
1431 }
1432
1433 return 0;
1434
1435 error:
1436 m66592->driver = NULL;
1437 m66592->gadget.dev.driver = NULL;
1438
1439 return retval;
1440 }
1441 EXPORT_SYMBOL(usb_gadget_register_driver);
1442
1443 int usb_gadget_unregister_driver(struct usb_gadget_driver *driver)
1444 {
1445 struct m66592 *m66592 = the_controller;
1446 unsigned long flags;
1447
1448 if (driver != m66592->driver || !driver->unbind)
1449 return -EINVAL;
1450
1451 spin_lock_irqsave(&m66592->lock, flags);
1452 if (m66592->gadget.speed != USB_SPEED_UNKNOWN)
1453 m66592_usb_disconnect(m66592);
1454 spin_unlock_irqrestore(&m66592->lock, flags);
1455
1456 m66592_bclr(m66592, M66592_VBSE | M66592_URST, M66592_INTENB0);
1457
1458 driver->unbind(&m66592->gadget);
1459
1460 init_controller(m66592);
1461 disable_controller(m66592);
1462
1463 device_del(&m66592->gadget.dev);
1464 m66592->driver = NULL;
1465 return 0;
1466 }
1467 EXPORT_SYMBOL(usb_gadget_unregister_driver);
1468
1469 /*-------------------------------------------------------------------------*/
1470 static int m66592_get_frame(struct usb_gadget *_gadget)
1471 {
1472 struct m66592 *m66592 = gadget_to_m66592(_gadget);
1473 return m66592_read(m66592, M66592_FRMNUM) & 0x03FF;
1474 }
1475
1476 static struct usb_gadget_ops m66592_gadget_ops = {
1477 .get_frame = m66592_get_frame,
1478 };
1479
1480 static int __exit m66592_remove(struct platform_device *pdev)
1481 {
1482 struct m66592 *m66592 = dev_get_drvdata(&pdev->dev);
1483
1484 del_timer_sync(&m66592->timer);
1485 iounmap(m66592->reg);
1486 free_irq(platform_get_irq(pdev, 0), m66592);
1487 m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req);
1488 kfree(m66592);
1489 return 0;
1490 }
1491
1492 static void nop_completion(struct usb_ep *ep, struct usb_request *r)
1493 {
1494 }
1495
1496 #define resource_len(r) (((r)->end - (r)->start) + 1)
1497
1498 static int __init m66592_probe(struct platform_device *pdev)
1499 {
1500 struct resource *res;
1501 int irq;
1502 void __iomem *reg = NULL;
1503 struct m66592 *m66592 = NULL;
1504 int ret = 0;
1505 int i;
1506
1507 res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
1508 (char *)udc_name);
1509 if (!res) {
1510 ret = -ENODEV;
1511 printk(KERN_ERR "platform_get_resource_byname error.\n");
1512 goto clean_up;
1513 }
1514
1515 irq = platform_get_irq(pdev, 0);
1516 if (irq < 0) {
1517 ret = -ENODEV;
1518 printk(KERN_ERR "platform_get_irq error.\n");
1519 goto clean_up;
1520 }
1521
1522 reg = ioremap(res->start, resource_len(res));
1523 if (reg == NULL) {
1524 ret = -ENOMEM;
1525 printk(KERN_ERR "ioremap error.\n");
1526 goto clean_up;
1527 }
1528
1529 /* initialize ucd */
1530 m66592 = kzalloc(sizeof(struct m66592), GFP_KERNEL);
1531 if (m66592 == NULL) {
1532 printk(KERN_ERR "kzalloc error\n");
1533 goto clean_up;
1534 }
1535
1536 spin_lock_init(&m66592->lock);
1537 dev_set_drvdata(&pdev->dev, m66592);
1538
1539 m66592->gadget.ops = &m66592_gadget_ops;
1540 device_initialize(&m66592->gadget.dev);
1541 strcpy(m66592->gadget.dev.bus_id, "gadget");
1542 m66592->gadget.is_dualspeed = 1;
1543 m66592->gadget.dev.parent = &pdev->dev;
1544 m66592->gadget.dev.dma_mask = pdev->dev.dma_mask;
1545 m66592->gadget.dev.release = pdev->dev.release;
1546 m66592->gadget.name = udc_name;
1547
1548 init_timer(&m66592->timer);
1549 m66592->timer.function = m66592_timer;
1550 m66592->timer.data = (unsigned long)m66592;
1551 m66592->reg = reg;
1552
1553 m66592->bi_bufnum = M66592_BASE_BUFNUM;
1554
1555 ret = request_irq(irq, m66592_irq, IRQF_DISABLED | IRQF_SHARED,
1556 udc_name, m66592);
1557 if (ret < 0) {
1558 printk(KERN_ERR "request_irq error (%d)\n", ret);
1559 goto clean_up;
1560 }
1561
1562 INIT_LIST_HEAD(&m66592->gadget.ep_list);
1563 m66592->gadget.ep0 = &m66592->ep[0].ep;
1564 INIT_LIST_HEAD(&m66592->gadget.ep0->ep_list);
1565 for (i = 0; i < M66592_MAX_NUM_PIPE; i++) {
1566 struct m66592_ep *ep = &m66592->ep[i];
1567
1568 if (i != 0) {
1569 INIT_LIST_HEAD(&m66592->ep[i].ep.ep_list);
1570 list_add_tail(&m66592->ep[i].ep.ep_list,
1571 &m66592->gadget.ep_list);
1572 }
1573 ep->m66592 = m66592;
1574 INIT_LIST_HEAD(&ep->queue);
1575 ep->ep.name = m66592_ep_name[i];
1576 ep->ep.ops = &m66592_ep_ops;
1577 ep->ep.maxpacket = 512;
1578 }
1579 m66592->ep[0].ep.maxpacket = 64;
1580 m66592->ep[0].pipenum = 0;
1581 m66592->ep[0].fifoaddr = M66592_CFIFO;
1582 m66592->ep[0].fifosel = M66592_CFIFOSEL;
1583 m66592->ep[0].fifoctr = M66592_CFIFOCTR;
1584 m66592->ep[0].fifotrn = 0;
1585 m66592->ep[0].pipectr = get_pipectr_addr(0);
1586 m66592->pipenum2ep[0] = &m66592->ep[0];
1587 m66592->epaddr2ep[0] = &m66592->ep[0];
1588
1589 the_controller = m66592;
1590
1591 m66592->ep0_req = m66592_alloc_request(&m66592->ep[0].ep, GFP_KERNEL);
1592 if (m66592->ep0_req == NULL)
1593 goto clean_up2;
1594 m66592->ep0_req->complete = nop_completion;
1595
1596 init_controller(m66592);
1597
1598 dev_info(&pdev->dev, "version %s\n", DRIVER_VERSION);
1599 return 0;
1600
1601 clean_up2:
1602 free_irq(irq, m66592);
1603 clean_up:
1604 if (m66592) {
1605 if (m66592->ep0_req)
1606 m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req);
1607 kfree(m66592);
1608 }
1609 if (reg)
1610 iounmap(reg);
1611
1612 return ret;
1613 }
1614
1615 /*-------------------------------------------------------------------------*/
1616 static struct platform_driver m66592_driver = {
1617 .remove = __exit_p(m66592_remove),
1618 .driver = {
1619 .name = (char *) udc_name,
1620 },
1621 };
1622
1623 static int __init m66592_udc_init(void)
1624 {
1625 return platform_driver_probe(&m66592_driver, m66592_probe);
1626 }
1627 module_init(m66592_udc_init);
1628
1629 static void __exit m66592_udc_cleanup(void)
1630 {
1631 platform_driver_unregister(&m66592_driver);
1632 }
1633 module_exit(m66592_udc_cleanup);
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree