diff options
Diffstat (limited to 'drivers/usb')
56 files changed, 2748 insertions, 1316 deletions
diff --git a/drivers/usb/class/cdc-acm.c b/drivers/usb/class/cdc-acm.c index 2bfc41ece0e1..85a1a55815cf 100644 --- a/drivers/usb/class/cdc-acm.c +++ b/drivers/usb/class/cdc-acm.c | |||
@@ -858,10 +858,7 @@ static void acm_tty_set_termios(struct tty_struct *tty, | |||
858 | if (!ACM_READY(acm)) | 858 | if (!ACM_READY(acm)) |
859 | return; | 859 | return; |
860 | 860 | ||
861 | /* FIXME: Needs to support the tty_baud interface */ | 861 | newline.dwDTERate = cpu_to_le32(tty_get_baud_rate(tty)); |
862 | /* FIXME: Broken on sparc */ | ||
863 | newline.dwDTERate = cpu_to_le32p(acm_tty_speed + | ||
864 | (termios->c_cflag & CBAUD & ~CBAUDEX) + (termios->c_cflag & CBAUDEX ? 15 : 0)); | ||
865 | newline.bCharFormat = termios->c_cflag & CSTOPB ? 2 : 0; | 862 | newline.bCharFormat = termios->c_cflag & CSTOPB ? 2 : 0; |
866 | newline.bParityType = termios->c_cflag & PARENB ? | 863 | newline.bParityType = termios->c_cflag & PARENB ? |
867 | (termios->c_cflag & PARODD ? 1 : 2) + | 864 | (termios->c_cflag & PARODD ? 1 : 2) + |
diff --git a/drivers/usb/class/usblp.c b/drivers/usb/class/usblp.c index 26c09f0257db..9bc112ee7803 100644 --- a/drivers/usb/class/usblp.c +++ b/drivers/usb/class/usblp.c | |||
@@ -1057,14 +1057,14 @@ static const struct file_operations usblp_fops = { | |||
1057 | .release = usblp_release, | 1057 | .release = usblp_release, |
1058 | }; | 1058 | }; |
1059 | 1059 | ||
1060 | static char *usblp_nodename(struct device *dev) | 1060 | static char *usblp_devnode(struct device *dev, mode_t *mode) |
1061 | { | 1061 | { |
1062 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); | 1062 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); |
1063 | } | 1063 | } |
1064 | 1064 | ||
1065 | static struct usb_class_driver usblp_class = { | 1065 | static struct usb_class_driver usblp_class = { |
1066 | .name = "lp%d", | 1066 | .name = "lp%d", |
1067 | .nodename = usblp_nodename, | 1067 | .devnode = usblp_devnode, |
1068 | .fops = &usblp_fops, | 1068 | .fops = &usblp_fops, |
1069 | .minor_base = USBLP_MINOR_BASE, | 1069 | .minor_base = USBLP_MINOR_BASE, |
1070 | }; | 1070 | }; |
diff --git a/drivers/usb/core/file.c b/drivers/usb/core/file.c index 5cef88929b3e..222ee07ea680 100644 --- a/drivers/usb/core/file.c +++ b/drivers/usb/core/file.c | |||
@@ -67,14 +67,14 @@ static struct usb_class { | |||
67 | struct class *class; | 67 | struct class *class; |
68 | } *usb_class; | 68 | } *usb_class; |
69 | 69 | ||
70 | static char *usb_nodename(struct device *dev) | 70 | static char *usb_devnode(struct device *dev, mode_t *mode) |
71 | { | 71 | { |
72 | struct usb_class_driver *drv; | 72 | struct usb_class_driver *drv; |
73 | 73 | ||
74 | drv = dev_get_drvdata(dev); | 74 | drv = dev_get_drvdata(dev); |
75 | if (!drv || !drv->nodename) | 75 | if (!drv || !drv->devnode) |
76 | return NULL; | 76 | return NULL; |
77 | return drv->nodename(dev); | 77 | return drv->devnode(dev, mode); |
78 | } | 78 | } |
79 | 79 | ||
80 | static int init_usb_class(void) | 80 | static int init_usb_class(void) |
@@ -100,7 +100,7 @@ static int init_usb_class(void) | |||
100 | kfree(usb_class); | 100 | kfree(usb_class); |
101 | usb_class = NULL; | 101 | usb_class = NULL; |
102 | } | 102 | } |
103 | usb_class->class->nodename = usb_nodename; | 103 | usb_class->class->devnode = usb_devnode; |
104 | 104 | ||
105 | exit: | 105 | exit: |
106 | return result; | 106 | return result; |
diff --git a/drivers/usb/core/usb.c b/drivers/usb/core/usb.c index a26f73880c32..43ee943d757a 100644 --- a/drivers/usb/core/usb.c +++ b/drivers/usb/core/usb.c | |||
@@ -311,7 +311,7 @@ static struct dev_pm_ops usb_device_pm_ops = { | |||
311 | #endif /* CONFIG_PM */ | 311 | #endif /* CONFIG_PM */ |
312 | 312 | ||
313 | 313 | ||
314 | static char *usb_nodename(struct device *dev) | 314 | static char *usb_devnode(struct device *dev, mode_t *mode) |
315 | { | 315 | { |
316 | struct usb_device *usb_dev; | 316 | struct usb_device *usb_dev; |
317 | 317 | ||
@@ -324,7 +324,7 @@ struct device_type usb_device_type = { | |||
324 | .name = "usb_device", | 324 | .name = "usb_device", |
325 | .release = usb_release_dev, | 325 | .release = usb_release_dev, |
326 | .uevent = usb_dev_uevent, | 326 | .uevent = usb_dev_uevent, |
327 | .nodename = usb_nodename, | 327 | .devnode = usb_devnode, |
328 | .pm = &usb_device_pm_ops, | 328 | .pm = &usb_device_pm_ops, |
329 | }; | 329 | }; |
330 | 330 | ||
diff --git a/drivers/usb/gadget/Kconfig b/drivers/usb/gadget/Kconfig index 7f8e83a954ac..9f986b417c5b 100644 --- a/drivers/usb/gadget/Kconfig +++ b/drivers/usb/gadget/Kconfig | |||
@@ -251,6 +251,24 @@ config USB_PXA25X_SMALL | |||
251 | default y if USB_ETH | 251 | default y if USB_ETH |
252 | default y if USB_G_SERIAL | 252 | default y if USB_G_SERIAL |
253 | 253 | ||
254 | config USB_GADGET_R8A66597 | ||
255 | boolean "Renesas R8A66597 USB Peripheral Controller" | ||
256 | select USB_GADGET_DUALSPEED | ||
257 | help | ||
258 | R8A66597 is a discrete USB host and peripheral controller chip that | ||
259 | supports both full and high speed USB 2.0 data transfers. | ||
260 | It has nine configurable endpoints, and endpoint zero. | ||
261 | |||
262 | Say "y" to link the driver statically, or "m" to build a | ||
263 | dynamically linked module called "r8a66597_udc" and force all | ||
264 | gadget drivers to also be dynamically linked. | ||
265 | |||
266 | config USB_R8A66597 | ||
267 | tristate | ||
268 | depends on USB_GADGET_R8A66597 | ||
269 | default USB_GADGET | ||
270 | select USB_GADGET_SELECTED | ||
271 | |||
254 | config USB_GADGET_PXA27X | 272 | config USB_GADGET_PXA27X |
255 | boolean "PXA 27x" | 273 | boolean "PXA 27x" |
256 | depends on ARCH_PXA && (PXA27x || PXA3xx) | 274 | depends on ARCH_PXA && (PXA27x || PXA3xx) |
@@ -360,16 +378,6 @@ config USB_M66592 | |||
360 | default USB_GADGET | 378 | default USB_GADGET |
361 | select USB_GADGET_SELECTED | 379 | select USB_GADGET_SELECTED |
362 | 380 | ||
363 | config SUPERH_BUILT_IN_M66592 | ||
364 | boolean "Enable SuperH built-in USB like the M66592" | ||
365 | depends on USB_GADGET_M66592 && CPU_SUBTYPE_SH7722 | ||
366 | help | ||
367 | SH7722 has USB like the M66592. | ||
368 | |||
369 | The transfer rate is very slow when use "Ethernet Gadget". | ||
370 | However, this problem is improved if change a value of | ||
371 | NET_IP_ALIGN to 4. | ||
372 | |||
373 | # | 381 | # |
374 | # Controllers available only in discrete form (and all PCI controllers) | 382 | # Controllers available only in discrete form (and all PCI controllers) |
375 | # | 383 | # |
diff --git a/drivers/usb/gadget/Makefile b/drivers/usb/gadget/Makefile index e6017e6bf6da..9d7b87c52e9f 100644 --- a/drivers/usb/gadget/Makefile +++ b/drivers/usb/gadget/Makefile | |||
@@ -23,6 +23,7 @@ ifeq ($(CONFIG_ARCH_MXC),y) | |||
23 | fsl_usb2_udc-objs += fsl_mx3_udc.o | 23 | fsl_usb2_udc-objs += fsl_mx3_udc.o |
24 | endif | 24 | endif |
25 | obj-$(CONFIG_USB_M66592) += m66592-udc.o | 25 | obj-$(CONFIG_USB_M66592) += m66592-udc.o |
26 | obj-$(CONFIG_USB_R8A66597) += r8a66597-udc.o | ||
26 | obj-$(CONFIG_USB_FSL_QE) += fsl_qe_udc.o | 27 | obj-$(CONFIG_USB_FSL_QE) += fsl_qe_udc.o |
27 | obj-$(CONFIG_USB_CI13XXX) += ci13xxx_udc.o | 28 | obj-$(CONFIG_USB_CI13XXX) += ci13xxx_udc.o |
28 | obj-$(CONFIG_USB_S3C_HSOTG) += s3c-hsotg.o | 29 | obj-$(CONFIG_USB_S3C_HSOTG) += s3c-hsotg.o |
diff --git a/drivers/usb/gadget/gadget_chips.h b/drivers/usb/gadget/gadget_chips.h index 8e0e9a0b7364..f2d270b202f2 100644 --- a/drivers/usb/gadget/gadget_chips.h +++ b/drivers/usb/gadget/gadget_chips.h | |||
@@ -173,6 +173,12 @@ | |||
173 | // CONFIG_USB_GADGET_AU1X00 | 173 | // CONFIG_USB_GADGET_AU1X00 |
174 | // ... | 174 | // ... |
175 | 175 | ||
176 | #ifdef CONFIG_USB_GADGET_R8A66597 | ||
177 | #define gadget_is_r8a66597(g) !strcmp("r8a66597_udc", (g)->name) | ||
178 | #else | ||
179 | #define gadget_is_r8a66597(g) 0 | ||
180 | #endif | ||
181 | |||
176 | 182 | ||
177 | /** | 183 | /** |
178 | * usb_gadget_controller_number - support bcdDevice id convention | 184 | * usb_gadget_controller_number - support bcdDevice id convention |
@@ -239,6 +245,8 @@ static inline int usb_gadget_controller_number(struct usb_gadget *gadget) | |||
239 | return 0x23; | 245 | return 0x23; |
240 | else if (gadget_is_langwell(gadget)) | 246 | else if (gadget_is_langwell(gadget)) |
241 | return 0x24; | 247 | return 0x24; |
248 | else if (gadget_is_r8a66597(gadget)) | ||
249 | return 0x25; | ||
242 | return -ENOENT; | 250 | return -ENOENT; |
243 | } | 251 | } |
244 | 252 | ||
diff --git a/drivers/usb/gadget/m66592-udc.c b/drivers/usb/gadget/m66592-udc.c index 43dcf9e1af6b..a8c8543d1b08 100644 --- a/drivers/usb/gadget/m66592-udc.c +++ b/drivers/usb/gadget/m66592-udc.c | |||
@@ -25,44 +25,18 @@ | |||
25 | #include <linux/delay.h> | 25 | #include <linux/delay.h> |
26 | #include <linux/io.h> | 26 | #include <linux/io.h> |
27 | #include <linux/platform_device.h> | 27 | #include <linux/platform_device.h> |
28 | 28 | #include <linux/err.h> | |
29 | #include <linux/usb/ch9.h> | 29 | #include <linux/usb/ch9.h> |
30 | #include <linux/usb/gadget.h> | 30 | #include <linux/usb/gadget.h> |
31 | 31 | ||
32 | #include "m66592-udc.h" | 32 | #include "m66592-udc.h" |
33 | 33 | ||
34 | |||
35 | MODULE_DESCRIPTION("M66592 USB gadget driver"); | 34 | MODULE_DESCRIPTION("M66592 USB gadget driver"); |
36 | MODULE_LICENSE("GPL"); | 35 | MODULE_LICENSE("GPL"); |
37 | MODULE_AUTHOR("Yoshihiro Shimoda"); | 36 | MODULE_AUTHOR("Yoshihiro Shimoda"); |
38 | MODULE_ALIAS("platform:m66592_udc"); | 37 | MODULE_ALIAS("platform:m66592_udc"); |
39 | 38 | ||
40 | #define DRIVER_VERSION "18 Oct 2007" | 39 | #define DRIVER_VERSION "21 July 2009" |
41 | |||
42 | /* module parameters */ | ||
43 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | ||
44 | static unsigned short endian = M66592_LITTLE; | ||
45 | module_param(endian, ushort, 0644); | ||
46 | MODULE_PARM_DESC(endian, "data endian: big=0, little=0 (default=0)"); | ||
47 | #else | ||
48 | static unsigned short clock = M66592_XTAL24; | ||
49 | module_param(clock, ushort, 0644); | ||
50 | MODULE_PARM_DESC(clock, "input clock: 48MHz=32768, 24MHz=16384, 12MHz=0 " | ||
51 | "(default=16384)"); | ||
52 | |||
53 | static unsigned short vif = M66592_LDRV; | ||
54 | module_param(vif, ushort, 0644); | ||
55 | MODULE_PARM_DESC(vif, "input VIF: 3.3V=32768, 1.5V=0 (default=32768)"); | ||
56 | |||
57 | static unsigned short endian; | ||
58 | module_param(endian, ushort, 0644); | ||
59 | MODULE_PARM_DESC(endian, "data endian: big=256, little=0 (default=0)"); | ||
60 | |||
61 | static unsigned short irq_sense = M66592_INTL; | ||
62 | module_param(irq_sense, ushort, 0644); | ||
63 | MODULE_PARM_DESC(irq_sense, "IRQ sense: low level=2, falling edge=0 " | ||
64 | "(default=2)"); | ||
65 | #endif | ||
66 | 40 | ||
67 | static const char udc_name[] = "m66592_udc"; | 41 | static const char udc_name[] = "m66592_udc"; |
68 | static const char *m66592_ep_name[] = { | 42 | static const char *m66592_ep_name[] = { |
@@ -244,6 +218,7 @@ static inline int get_buffer_size(struct m66592 *m66592, u16 pipenum) | |||
244 | static inline void pipe_change(struct m66592 *m66592, u16 pipenum) | 218 | static inline void pipe_change(struct m66592 *m66592, u16 pipenum) |
245 | { | 219 | { |
246 | struct m66592_ep *ep = m66592->pipenum2ep[pipenum]; | 220 | struct m66592_ep *ep = m66592->pipenum2ep[pipenum]; |
221 | unsigned short mbw; | ||
247 | 222 | ||
248 | if (ep->use_dma) | 223 | if (ep->use_dma) |
249 | return; | 224 | return; |
@@ -252,7 +227,12 @@ static inline void pipe_change(struct m66592 *m66592, u16 pipenum) | |||
252 | 227 | ||
253 | ndelay(450); | 228 | ndelay(450); |
254 | 229 | ||
255 | m66592_bset(m66592, M66592_MBW, ep->fifosel); | 230 | if (m66592->pdata->on_chip) |
231 | mbw = M66592_MBW_32; | ||
232 | else | ||
233 | mbw = M66592_MBW_16; | ||
234 | |||
235 | m66592_bset(m66592, mbw, ep->fifosel); | ||
256 | } | 236 | } |
257 | 237 | ||
258 | static int pipe_buffer_setting(struct m66592 *m66592, | 238 | static int pipe_buffer_setting(struct m66592 *m66592, |
@@ -276,24 +256,27 @@ static int pipe_buffer_setting(struct m66592 *m66592, | |||
276 | buf_bsize = 0; | 256 | buf_bsize = 0; |
277 | break; | 257 | break; |
278 | case M66592_BULK: | 258 | case M66592_BULK: |
279 | bufnum = m66592->bi_bufnum + | 259 | /* isochronous pipes may be used as bulk pipes */ |
280 | (info->pipe - M66592_BASE_PIPENUM_BULK) * 16; | 260 | if (info->pipe > M66592_BASE_PIPENUM_BULK) |
281 | m66592->bi_bufnum += 16; | 261 | bufnum = info->pipe - M66592_BASE_PIPENUM_BULK; |
262 | else | ||
263 | bufnum = info->pipe - M66592_BASE_PIPENUM_ISOC; | ||
264 | |||
265 | bufnum = M66592_BASE_BUFNUM + (bufnum * 16); | ||
282 | buf_bsize = 7; | 266 | buf_bsize = 7; |
283 | pipecfg |= M66592_DBLB; | 267 | pipecfg |= M66592_DBLB; |
284 | if (!info->dir_in) | 268 | if (!info->dir_in) |
285 | pipecfg |= M66592_SHTNAK; | 269 | pipecfg |= M66592_SHTNAK; |
286 | break; | 270 | break; |
287 | case M66592_ISO: | 271 | case M66592_ISO: |
288 | bufnum = m66592->bi_bufnum + | 272 | bufnum = M66592_BASE_BUFNUM + |
289 | (info->pipe - M66592_BASE_PIPENUM_ISOC) * 16; | 273 | (info->pipe - M66592_BASE_PIPENUM_ISOC) * 16; |
290 | m66592->bi_bufnum += 16; | ||
291 | buf_bsize = 7; | 274 | buf_bsize = 7; |
292 | break; | 275 | break; |
293 | } | 276 | } |
294 | if (m66592->bi_bufnum > M66592_MAX_BUFNUM) { | 277 | |
295 | pr_err("m66592 pipe memory is insufficient(%d)\n", | 278 | if (buf_bsize && ((bufnum + 16) >= M66592_MAX_BUFNUM)) { |
296 | m66592->bi_bufnum); | 279 | pr_err("m66592 pipe memory is insufficient\n"); |
297 | return -ENOMEM; | 280 | return -ENOMEM; |
298 | } | 281 | } |
299 | 282 | ||
@@ -313,17 +296,6 @@ static void pipe_buffer_release(struct m66592 *m66592, | |||
313 | if (info->pipe == 0) | 296 | if (info->pipe == 0) |
314 | return; | 297 | return; |
315 | 298 | ||
316 | switch (info->type) { | ||
317 | case M66592_BULK: | ||
318 | if (is_bulk_pipe(info->pipe)) | ||
319 | m66592->bi_bufnum -= 16; | ||
320 | break; | ||
321 | case M66592_ISO: | ||
322 | if (is_isoc_pipe(info->pipe)) | ||
323 | m66592->bi_bufnum -= 16; | ||
324 | break; | ||
325 | } | ||
326 | |||
327 | if (is_bulk_pipe(info->pipe)) { | 299 | if (is_bulk_pipe(info->pipe)) { |
328 | m66592->bulk--; | 300 | m66592->bulk--; |
329 | } else if (is_interrupt_pipe(info->pipe)) | 301 | } else if (is_interrupt_pipe(info->pipe)) |
@@ -340,6 +312,7 @@ static void pipe_buffer_release(struct m66592 *m66592, | |||
340 | static void pipe_initialize(struct m66592_ep *ep) | 312 | static void pipe_initialize(struct m66592_ep *ep) |
341 | { | 313 | { |
342 | struct m66592 *m66592 = ep->m66592; | 314 | struct m66592 *m66592 = ep->m66592; |
315 | unsigned short mbw; | ||
343 | 316 | ||
344 | m66592_mdfy(m66592, 0, M66592_CURPIPE, ep->fifosel); | 317 | m66592_mdfy(m66592, 0, M66592_CURPIPE, ep->fifosel); |
345 | 318 | ||
@@ -351,7 +324,12 @@ static void pipe_initialize(struct m66592_ep *ep) | |||
351 | 324 | ||
352 | ndelay(450); | 325 | ndelay(450); |
353 | 326 | ||
354 | m66592_bset(m66592, M66592_MBW, ep->fifosel); | 327 | if (m66592->pdata->on_chip) |
328 | mbw = M66592_MBW_32; | ||
329 | else | ||
330 | mbw = M66592_MBW_16; | ||
331 | |||
332 | m66592_bset(m66592, mbw, ep->fifosel); | ||
355 | } | 333 | } |
356 | } | 334 | } |
357 | 335 | ||
@@ -367,15 +345,13 @@ static void m66592_ep_setting(struct m66592 *m66592, struct m66592_ep *ep, | |||
367 | ep->fifosel = M66592_D0FIFOSEL; | 345 | ep->fifosel = M66592_D0FIFOSEL; |
368 | ep->fifoctr = M66592_D0FIFOCTR; | 346 | ep->fifoctr = M66592_D0FIFOCTR; |
369 | ep->fifotrn = M66592_D0FIFOTRN; | 347 | ep->fifotrn = M66592_D0FIFOTRN; |
370 | #if !defined(CONFIG_SUPERH_BUILT_IN_M66592) | 348 | } else if (!m66592->pdata->on_chip && m66592->num_dma == 1) { |
371 | } else if (m66592->num_dma == 1) { | ||
372 | m66592->num_dma++; | 349 | m66592->num_dma++; |
373 | ep->use_dma = 1; | 350 | ep->use_dma = 1; |
374 | ep->fifoaddr = M66592_D1FIFO; | 351 | ep->fifoaddr = M66592_D1FIFO; |
375 | ep->fifosel = M66592_D1FIFOSEL; | 352 | ep->fifosel = M66592_D1FIFOSEL; |
376 | ep->fifoctr = M66592_D1FIFOCTR; | 353 | ep->fifoctr = M66592_D1FIFOCTR; |
377 | ep->fifotrn = M66592_D1FIFOTRN; | 354 | ep->fifotrn = M66592_D1FIFOTRN; |
378 | #endif | ||
379 | } else { | 355 | } else { |
380 | ep->use_dma = 0; | 356 | ep->use_dma = 0; |
381 | ep->fifoaddr = M66592_CFIFO; | 357 | ep->fifoaddr = M66592_CFIFO; |
@@ -620,76 +596,120 @@ static void start_ep0(struct m66592_ep *ep, struct m66592_request *req) | |||
620 | } | 596 | } |
621 | } | 597 | } |
622 | 598 | ||
623 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | ||
624 | static void init_controller(struct m66592 *m66592) | 599 | static void init_controller(struct m66592 *m66592) |
625 | { | 600 | { |
626 | m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */ | 601 | unsigned int endian; |
627 | m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG); | ||
628 | m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG); | ||
629 | m66592_bset(m66592, M66592_USBE, M66592_SYSCFG); | ||
630 | 602 | ||
631 | /* This is a workaound for SH7722 2nd cut */ | 603 | if (m66592->pdata->on_chip) { |
632 | m66592_bset(m66592, 0x8000, M66592_DVSTCTR); | 604 | if (m66592->pdata->endian) |
633 | m66592_bset(m66592, 0x1000, M66592_TESTMODE); | 605 | endian = 0; /* big endian */ |
634 | m66592_bclr(m66592, 0x8000, M66592_DVSTCTR); | 606 | else |
607 | endian = M66592_LITTLE; /* little endian */ | ||
635 | 608 | ||
636 | m66592_bset(m66592, M66592_INTL, M66592_INTENB1); | 609 | m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */ |
610 | m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG); | ||
611 | m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG); | ||
612 | m66592_bset(m66592, M66592_USBE, M66592_SYSCFG); | ||
637 | 613 | ||
638 | m66592_write(m66592, 0, M66592_CFBCFG); | 614 | /* This is a workaound for SH7722 2nd cut */ |
639 | m66592_write(m66592, 0, M66592_D0FBCFG); | 615 | m66592_bset(m66592, 0x8000, M66592_DVSTCTR); |
640 | m66592_bset(m66592, endian, M66592_CFBCFG); | 616 | m66592_bset(m66592, 0x1000, M66592_TESTMODE); |
641 | m66592_bset(m66592, endian, M66592_D0FBCFG); | 617 | m66592_bclr(m66592, 0x8000, M66592_DVSTCTR); |
642 | } | ||
643 | #else /* #if defined(CONFIG_SUPERH_BUILT_IN_M66592) */ | ||
644 | static void init_controller(struct m66592 *m66592) | ||
645 | { | ||
646 | m66592_bset(m66592, (vif & M66592_LDRV) | (endian & M66592_BIGEND), | ||
647 | M66592_PINCFG); | ||
648 | m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */ | ||
649 | m66592_mdfy(m66592, clock & M66592_XTAL, M66592_XTAL, M66592_SYSCFG); | ||
650 | 618 | ||
651 | m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG); | 619 | m66592_bset(m66592, M66592_INTL, M66592_INTENB1); |
652 | m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG); | 620 | |
653 | m66592_bset(m66592, M66592_USBE, M66592_SYSCFG); | 621 | m66592_write(m66592, 0, M66592_CFBCFG); |
622 | m66592_write(m66592, 0, M66592_D0FBCFG); | ||
623 | m66592_bset(m66592, endian, M66592_CFBCFG); | ||
624 | m66592_bset(m66592, endian, M66592_D0FBCFG); | ||
625 | } else { | ||
626 | unsigned int clock, vif, irq_sense; | ||
627 | |||
628 | if (m66592->pdata->endian) | ||
629 | endian = M66592_BIGEND; /* big endian */ | ||
630 | else | ||
631 | endian = 0; /* little endian */ | ||
632 | |||
633 | if (m66592->pdata->vif) | ||
634 | vif = M66592_LDRV; /* 3.3v */ | ||
635 | else | ||
636 | vif = 0; /* 1.5v */ | ||
637 | |||
638 | switch (m66592->pdata->xtal) { | ||
639 | case M66592_PLATDATA_XTAL_12MHZ: | ||
640 | clock = M66592_XTAL12; | ||
641 | break; | ||
642 | case M66592_PLATDATA_XTAL_24MHZ: | ||
643 | clock = M66592_XTAL24; | ||
644 | break; | ||
645 | case M66592_PLATDATA_XTAL_48MHZ: | ||
646 | clock = M66592_XTAL48; | ||
647 | break; | ||
648 | default: | ||
649 | pr_warning("m66592-udc: xtal configuration error\n"); | ||
650 | clock = 0; | ||
651 | } | ||
652 | |||
653 | switch (m66592->irq_trigger) { | ||
654 | case IRQF_TRIGGER_LOW: | ||
655 | irq_sense = M66592_INTL; | ||
656 | break; | ||
657 | case IRQF_TRIGGER_FALLING: | ||
658 | irq_sense = 0; | ||
659 | break; | ||
660 | default: | ||
661 | pr_warning("m66592-udc: irq trigger config error\n"); | ||
662 | irq_sense = 0; | ||
663 | } | ||
654 | 664 | ||
655 | m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG); | 665 | m66592_bset(m66592, |
666 | (vif & M66592_LDRV) | (endian & M66592_BIGEND), | ||
667 | M66592_PINCFG); | ||
668 | m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */ | ||
669 | m66592_mdfy(m66592, clock & M66592_XTAL, M66592_XTAL, | ||
670 | M66592_SYSCFG); | ||
671 | m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG); | ||
672 | m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG); | ||
673 | m66592_bset(m66592, M66592_USBE, M66592_SYSCFG); | ||
674 | |||
675 | m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG); | ||
656 | 676 | ||
657 | msleep(3); | 677 | msleep(3); |
658 | 678 | ||
659 | m66592_bset(m66592, M66592_RCKE | M66592_PLLC, M66592_SYSCFG); | 679 | m66592_bset(m66592, M66592_RCKE | M66592_PLLC, M66592_SYSCFG); |
660 | 680 | ||
661 | msleep(1); | 681 | msleep(1); |
662 | 682 | ||
663 | m66592_bset(m66592, M66592_SCKE, M66592_SYSCFG); | 683 | m66592_bset(m66592, M66592_SCKE, M66592_SYSCFG); |
664 | 684 | ||
665 | m66592_bset(m66592, irq_sense & M66592_INTL, M66592_INTENB1); | 685 | m66592_bset(m66592, irq_sense & M66592_INTL, M66592_INTENB1); |
666 | m66592_write(m66592, M66592_BURST | M66592_CPU_ADR_RD_WR, | 686 | m66592_write(m66592, M66592_BURST | M66592_CPU_ADR_RD_WR, |
667 | M66592_DMA0CFG); | 687 | M66592_DMA0CFG); |
688 | } | ||
668 | } | 689 | } |
669 | #endif /* #if defined(CONFIG_SUPERH_BUILT_IN_M66592) */ | ||
670 | 690 | ||
671 | static void disable_controller(struct m66592 *m66592) | 691 | static void disable_controller(struct m66592 *m66592) |
672 | { | 692 | { |
673 | #if !defined(CONFIG_SUPERH_BUILT_IN_M66592) | 693 | if (!m66592->pdata->on_chip) { |
674 | m66592_bclr(m66592, M66592_SCKE, M66592_SYSCFG); | 694 | m66592_bclr(m66592, M66592_SCKE, M66592_SYSCFG); |
675 | udelay(1); | 695 | udelay(1); |
676 | m66592_bclr(m66592, M66592_PLLC, M66592_SYSCFG); | 696 | m66592_bclr(m66592, M66592_PLLC, M66592_SYSCFG); |
677 | udelay(1); | 697 | udelay(1); |
678 | m66592_bclr(m66592, M66592_RCKE, M66592_SYSCFG); | 698 | m66592_bclr(m66592, M66592_RCKE, M66592_SYSCFG); |
679 | udelay(1); | 699 | udelay(1); |
680 | m66592_bclr(m66592, M66592_XCKE, M66592_SYSCFG); | 700 | m66592_bclr(m66592, M66592_XCKE, M66592_SYSCFG); |
681 | #endif | 701 | } |
682 | } | 702 | } |
683 | 703 | ||
684 | static void m66592_start_xclock(struct m66592 *m66592) | 704 | static void m66592_start_xclock(struct m66592 *m66592) |
685 | { | 705 | { |
686 | #if !defined(CONFIG_SUPERH_BUILT_IN_M66592) | ||
687 | u16 tmp; | 706 | u16 tmp; |
688 | 707 | ||
689 | tmp = m66592_read(m66592, M66592_SYSCFG); | 708 | if (!m66592->pdata->on_chip) { |
690 | if (!(tmp & M66592_XCKE)) | 709 | tmp = m66592_read(m66592, M66592_SYSCFG); |
691 | m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG); | 710 | if (!(tmp & M66592_XCKE)) |
692 | #endif | 711 | m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG); |
712 | } | ||
693 | } | 713 | } |
694 | 714 | ||
695 | /*-------------------------------------------------------------------------*/ | 715 | /*-------------------------------------------------------------------------*/ |
@@ -1177,8 +1197,7 @@ static irqreturn_t m66592_irq(int irq, void *_m66592) | |||
1177 | intsts0 = m66592_read(m66592, M66592_INTSTS0); | 1197 | intsts0 = m66592_read(m66592, M66592_INTSTS0); |
1178 | intenb0 = m66592_read(m66592, M66592_INTENB0); | 1198 | intenb0 = m66592_read(m66592, M66592_INTENB0); |
1179 | 1199 | ||
1180 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | 1200 | if (m66592->pdata->on_chip && !intsts0 && !intenb0) { |
1181 | if (!intsts0 && !intenb0) { | ||
1182 | /* | 1201 | /* |
1183 | * When USB clock stops, it cannot read register. Even if a | 1202 | * When USB clock stops, it cannot read register. Even if a |
1184 | * clock stops, the interrupt occurs. So this driver turn on | 1203 | * clock stops, the interrupt occurs. So this driver turn on |
@@ -1188,7 +1207,6 @@ static irqreturn_t m66592_irq(int irq, void *_m66592) | |||
1188 | intsts0 = m66592_read(m66592, M66592_INTSTS0); | 1207 | intsts0 = m66592_read(m66592, M66592_INTSTS0); |
1189 | intenb0 = m66592_read(m66592, M66592_INTENB0); | 1208 | intenb0 = m66592_read(m66592, M66592_INTENB0); |
1190 | } | 1209 | } |
1191 | #endif | ||
1192 | 1210 | ||
1193 | savepipe = m66592_read(m66592, M66592_CFIFOSEL); | 1211 | savepipe = m66592_read(m66592, M66592_CFIFOSEL); |
1194 | 1212 | ||
@@ -1534,9 +1552,11 @@ static int __exit m66592_remove(struct platform_device *pdev) | |||
1534 | iounmap(m66592->reg); | 1552 | iounmap(m66592->reg); |
1535 | free_irq(platform_get_irq(pdev, 0), m66592); | 1553 | free_irq(platform_get_irq(pdev, 0), m66592); |
1536 | m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req); | 1554 | m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req); |
1537 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) && defined(CONFIG_HAVE_CLK) | 1555 | #ifdef CONFIG_HAVE_CLK |
1538 | clk_disable(m66592->clk); | 1556 | if (m66592->pdata->on_chip) { |
1539 | clk_put(m66592->clk); | 1557 | clk_disable(m66592->clk); |
1558 | clk_put(m66592->clk); | ||
1559 | } | ||
1540 | #endif | 1560 | #endif |
1541 | kfree(m66592); | 1561 | kfree(m66592); |
1542 | return 0; | 1562 | return 0; |
@@ -1548,11 +1568,10 @@ static void nop_completion(struct usb_ep *ep, struct usb_request *r) | |||
1548 | 1568 | ||
1549 | static int __init m66592_probe(struct platform_device *pdev) | 1569 | static int __init m66592_probe(struct platform_device *pdev) |
1550 | { | 1570 | { |
1551 | struct resource *res; | 1571 | struct resource *res, *ires; |
1552 | int irq; | ||
1553 | void __iomem *reg = NULL; | 1572 | void __iomem *reg = NULL; |
1554 | struct m66592 *m66592 = NULL; | 1573 | struct m66592 *m66592 = NULL; |
1555 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) && defined(CONFIG_HAVE_CLK) | 1574 | #ifdef CONFIG_HAVE_CLK |
1556 | char clk_name[8]; | 1575 | char clk_name[8]; |
1557 | #endif | 1576 | #endif |
1558 | int ret = 0; | 1577 | int ret = 0; |
@@ -1565,10 +1584,11 @@ static int __init m66592_probe(struct platform_device *pdev) | |||
1565 | goto clean_up; | 1584 | goto clean_up; |
1566 | } | 1585 | } |
1567 | 1586 | ||
1568 | irq = platform_get_irq(pdev, 0); | 1587 | ires = platform_get_resource(pdev, IORESOURCE_IRQ, 0); |
1569 | if (irq < 0) { | 1588 | if (!ires) { |
1570 | ret = -ENODEV; | 1589 | ret = -ENODEV; |
1571 | pr_err("platform_get_irq error.\n"); | 1590 | dev_err(&pdev->dev, |
1591 | "platform_get_resource IORESOURCE_IRQ error.\n"); | ||
1572 | goto clean_up; | 1592 | goto clean_up; |
1573 | } | 1593 | } |
1574 | 1594 | ||
@@ -1579,6 +1599,12 @@ static int __init m66592_probe(struct platform_device *pdev) | |||
1579 | goto clean_up; | 1599 | goto clean_up; |
1580 | } | 1600 | } |
1581 | 1601 | ||
1602 | if (pdev->dev.platform_data == NULL) { | ||
1603 | dev_err(&pdev->dev, "no platform data\n"); | ||
1604 | ret = -ENODEV; | ||
1605 | goto clean_up; | ||
1606 | } | ||
1607 | |||
1582 | /* initialize ucd */ | 1608 | /* initialize ucd */ |
1583 | m66592 = kzalloc(sizeof(struct m66592), GFP_KERNEL); | 1609 | m66592 = kzalloc(sizeof(struct m66592), GFP_KERNEL); |
1584 | if (m66592 == NULL) { | 1610 | if (m66592 == NULL) { |
@@ -1586,6 +1612,9 @@ static int __init m66592_probe(struct platform_device *pdev) | |||
1586 | goto clean_up; | 1612 | goto clean_up; |
1587 | } | 1613 | } |
1588 | 1614 | ||
1615 | m66592->pdata = pdev->dev.platform_data; | ||
1616 | m66592->irq_trigger = ires->flags & IRQF_TRIGGER_MASK; | ||
1617 | |||
1589 | spin_lock_init(&m66592->lock); | 1618 | spin_lock_init(&m66592->lock); |
1590 | dev_set_drvdata(&pdev->dev, m66592); | 1619 | dev_set_drvdata(&pdev->dev, m66592); |
1591 | 1620 | ||
@@ -1603,24 +1632,25 @@ static int __init m66592_probe(struct platform_device *pdev) | |||
1603 | m66592->timer.data = (unsigned long)m66592; | 1632 | m66592->timer.data = (unsigned long)m66592; |
1604 | m66592->reg = reg; | 1633 | m66592->reg = reg; |
1605 | 1634 | ||
1606 | m66592->bi_bufnum = M66592_BASE_BUFNUM; | 1635 | ret = request_irq(ires->start, m66592_irq, IRQF_DISABLED | IRQF_SHARED, |
1607 | |||
1608 | ret = request_irq(irq, m66592_irq, IRQF_DISABLED | IRQF_SHARED, | ||
1609 | udc_name, m66592); | 1636 | udc_name, m66592); |
1610 | if (ret < 0) { | 1637 | if (ret < 0) { |
1611 | pr_err("request_irq error (%d)\n", ret); | 1638 | pr_err("request_irq error (%d)\n", ret); |
1612 | goto clean_up; | 1639 | goto clean_up; |
1613 | } | 1640 | } |
1614 | 1641 | ||
1615 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) && defined(CONFIG_HAVE_CLK) | 1642 | #ifdef CONFIG_HAVE_CLK |
1616 | snprintf(clk_name, sizeof(clk_name), "usbf%d", pdev->id); | 1643 | if (m66592->pdata->on_chip) { |
1617 | m66592->clk = clk_get(&pdev->dev, clk_name); | 1644 | snprintf(clk_name, sizeof(clk_name), "usbf%d", pdev->id); |
1618 | if (IS_ERR(m66592->clk)) { | 1645 | m66592->clk = clk_get(&pdev->dev, clk_name); |
1619 | dev_err(&pdev->dev, "cannot get clock \"%s\"\n", clk_name); | 1646 | if (IS_ERR(m66592->clk)) { |
1620 | ret = PTR_ERR(m66592->clk); | 1647 | dev_err(&pdev->dev, "cannot get clock \"%s\"\n", |
1621 | goto clean_up2; | 1648 | clk_name); |
1649 | ret = PTR_ERR(m66592->clk); | ||
1650 | goto clean_up2; | ||
1651 | } | ||
1652 | clk_enable(m66592->clk); | ||
1622 | } | 1653 | } |
1623 | clk_enable(m66592->clk); | ||
1624 | #endif | 1654 | #endif |
1625 | INIT_LIST_HEAD(&m66592->gadget.ep_list); | 1655 | INIT_LIST_HEAD(&m66592->gadget.ep_list); |
1626 | m66592->gadget.ep0 = &m66592->ep[0].ep; | 1656 | m66592->gadget.ep0 = &m66592->ep[0].ep; |
@@ -1662,12 +1692,14 @@ static int __init m66592_probe(struct platform_device *pdev) | |||
1662 | return 0; | 1692 | return 0; |
1663 | 1693 | ||
1664 | clean_up3: | 1694 | clean_up3: |
1665 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) && defined(CONFIG_HAVE_CLK) | 1695 | #ifdef CONFIG_HAVE_CLK |
1666 | clk_disable(m66592->clk); | 1696 | if (m66592->pdata->on_chip) { |
1667 | clk_put(m66592->clk); | 1697 | clk_disable(m66592->clk); |
1698 | clk_put(m66592->clk); | ||
1699 | } | ||
1668 | clean_up2: | 1700 | clean_up2: |
1669 | #endif | 1701 | #endif |
1670 | free_irq(irq, m66592); | 1702 | free_irq(ires->start, m66592); |
1671 | clean_up: | 1703 | clean_up: |
1672 | if (m66592) { | 1704 | if (m66592) { |
1673 | if (m66592->ep0_req) | 1705 | if (m66592->ep0_req) |
diff --git a/drivers/usb/gadget/m66592-udc.h b/drivers/usb/gadget/m66592-udc.h index 286ce07e7960..8b960deed680 100644 --- a/drivers/usb/gadget/m66592-udc.h +++ b/drivers/usb/gadget/m66592-udc.h | |||
@@ -23,10 +23,12 @@ | |||
23 | #ifndef __M66592_UDC_H__ | 23 | #ifndef __M66592_UDC_H__ |
24 | #define __M66592_UDC_H__ | 24 | #define __M66592_UDC_H__ |
25 | 25 | ||
26 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) && defined(CONFIG_HAVE_CLK) | 26 | #ifdef CONFIG_HAVE_CLK |
27 | #include <linux/clk.h> | 27 | #include <linux/clk.h> |
28 | #endif | 28 | #endif |
29 | 29 | ||
30 | #include <linux/usb/m66592.h> | ||
31 | |||
30 | #define M66592_SYSCFG 0x00 | 32 | #define M66592_SYSCFG 0x00 |
31 | #define M66592_XTAL 0xC000 /* b15-14: Crystal selection */ | 33 | #define M66592_XTAL 0xC000 /* b15-14: Crystal selection */ |
32 | #define M66592_XTAL48 0x8000 /* 48MHz */ | 34 | #define M66592_XTAL48 0x8000 /* 48MHz */ |
@@ -76,11 +78,11 @@ | |||
76 | #define M66592_P_TST_J 0x0001 /* PERI TEST J */ | 78 | #define M66592_P_TST_J 0x0001 /* PERI TEST J */ |
77 | #define M66592_P_TST_NORMAL 0x0000 /* PERI Normal Mode */ | 79 | #define M66592_P_TST_NORMAL 0x0000 /* PERI Normal Mode */ |
78 | 80 | ||
79 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | 81 | /* built-in registers */ |
80 | #define M66592_CFBCFG 0x0A | 82 | #define M66592_CFBCFG 0x0A |
81 | #define M66592_D0FBCFG 0x0C | 83 | #define M66592_D0FBCFG 0x0C |
82 | #define M66592_LITTLE 0x0100 /* b8: Little endian mode */ | 84 | #define M66592_LITTLE 0x0100 /* b8: Little endian mode */ |
83 | #else | 85 | /* external chip case */ |
84 | #define M66592_PINCFG 0x0A | 86 | #define M66592_PINCFG 0x0A |
85 | #define M66592_LDRV 0x8000 /* b15: Drive Current Adjust */ | 87 | #define M66592_LDRV 0x8000 /* b15: Drive Current Adjust */ |
86 | #define M66592_BIGEND 0x0100 /* b8: Big endian mode */ | 88 | #define M66592_BIGEND 0x0100 /* b8: Big endian mode */ |
@@ -100,8 +102,8 @@ | |||
100 | #define M66592_PKTM 0x0020 /* b5: Packet mode */ | 102 | #define M66592_PKTM 0x0020 /* b5: Packet mode */ |
101 | #define M66592_DENDE 0x0010 /* b4: Dend enable */ | 103 | #define M66592_DENDE 0x0010 /* b4: Dend enable */ |
102 | #define M66592_OBUS 0x0004 /* b2: OUTbus mode */ | 104 | #define M66592_OBUS 0x0004 /* b2: OUTbus mode */ |
103 | #endif /* #if defined(CONFIG_SUPERH_BUILT_IN_M66592) */ | ||
104 | 105 | ||
106 | /* common case */ | ||
105 | #define M66592_CFIFO 0x10 | 107 | #define M66592_CFIFO 0x10 |
106 | #define M66592_D0FIFO 0x14 | 108 | #define M66592_D0FIFO 0x14 |
107 | #define M66592_D1FIFO 0x18 | 109 | #define M66592_D1FIFO 0x18 |
@@ -113,13 +115,9 @@ | |||
113 | #define M66592_REW 0x4000 /* b14: Buffer rewind */ | 115 | #define M66592_REW 0x4000 /* b14: Buffer rewind */ |
114 | #define M66592_DCLRM 0x2000 /* b13: DMA buffer clear mode */ | 116 | #define M66592_DCLRM 0x2000 /* b13: DMA buffer clear mode */ |
115 | #define M66592_DREQE 0x1000 /* b12: DREQ output enable */ | 117 | #define M66592_DREQE 0x1000 /* b12: DREQ output enable */ |
116 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | 118 | #define M66592_MBW_8 0x0000 /* 8bit */ |
117 | #define M66592_MBW 0x0800 /* b11: Maximum bit width for FIFO */ | 119 | #define M66592_MBW_16 0x0400 /* 16bit */ |
118 | #else | 120 | #define M66592_MBW_32 0x0800 /* 32bit */ |
119 | #define M66592_MBW 0x0400 /* b10: Maximum bit width for FIFO */ | ||
120 | #define M66592_MBW_8 0x0000 /* 8bit */ | ||
121 | #define M66592_MBW_16 0x0400 /* 16bit */ | ||
122 | #endif /* #if defined(CONFIG_SUPERH_BUILT_IN_M66592) */ | ||
123 | #define M66592_TRENB 0x0200 /* b9: Transaction counter enable */ | 121 | #define M66592_TRENB 0x0200 /* b9: Transaction counter enable */ |
124 | #define M66592_TRCLR 0x0100 /* b8: Transaction counter clear */ | 122 | #define M66592_TRCLR 0x0100 /* b8: Transaction counter clear */ |
125 | #define M66592_DEZPM 0x0080 /* b7: Zero-length packet mode */ | 123 | #define M66592_DEZPM 0x0080 /* b7: Zero-length packet mode */ |
@@ -480,9 +478,11 @@ struct m66592_ep { | |||
480 | struct m66592 { | 478 | struct m66592 { |
481 | spinlock_t lock; | 479 | spinlock_t lock; |
482 | void __iomem *reg; | 480 | void __iomem *reg; |
483 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) && defined(CONFIG_HAVE_CLK) | 481 | #ifdef CONFIG_HAVE_CLK |
484 | struct clk *clk; | 482 | struct clk *clk; |
485 | #endif | 483 | #endif |
484 | struct m66592_platdata *pdata; | ||
485 | unsigned long irq_trigger; | ||
486 | 486 | ||
487 | struct usb_gadget gadget; | 487 | struct usb_gadget gadget; |
488 | struct usb_gadget_driver *driver; | 488 | struct usb_gadget_driver *driver; |
@@ -506,7 +506,6 @@ struct m66592 { | |||
506 | int interrupt; | 506 | int interrupt; |
507 | int isochronous; | 507 | int isochronous; |
508 | int num_dma; | 508 | int num_dma; |
509 | int bi_bufnum; /* bulk and isochronous's bufnum */ | ||
510 | }; | 509 | }; |
511 | 510 | ||
512 | #define gadget_to_m66592(_gadget) container_of(_gadget, struct m66592, gadget) | 511 | #define gadget_to_m66592(_gadget) container_of(_gadget, struct m66592, gadget) |
@@ -547,13 +546,13 @@ static inline void m66592_read_fifo(struct m66592 *m66592, | |||
547 | { | 546 | { |
548 | unsigned long fifoaddr = (unsigned long)m66592->reg + offset; | 547 | unsigned long fifoaddr = (unsigned long)m66592->reg + offset; |
549 | 548 | ||
550 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | 549 | if (m66592->pdata->on_chip) { |
551 | len = (len + 3) / 4; | 550 | len = (len + 3) / 4; |
552 | insl(fifoaddr, buf, len); | 551 | insl(fifoaddr, buf, len); |
553 | #else | 552 | } else { |
554 | len = (len + 1) / 2; | 553 | len = (len + 1) / 2; |
555 | insw(fifoaddr, buf, len); | 554 | insw(fifoaddr, buf, len); |
556 | #endif | 555 | } |
557 | } | 556 | } |
558 | 557 | ||
559 | static inline void m66592_write(struct m66592 *m66592, u16 val, | 558 | static inline void m66592_write(struct m66592 *m66592, u16 val, |
@@ -567,33 +566,34 @@ static inline void m66592_write_fifo(struct m66592 *m66592, | |||
567 | void *buf, unsigned long len) | 566 | void *buf, unsigned long len) |
568 | { | 567 | { |
569 | unsigned long fifoaddr = (unsigned long)m66592->reg + offset; | 568 | unsigned long fifoaddr = (unsigned long)m66592->reg + offset; |
570 | #if defined(CONFIG_SUPERH_BUILT_IN_M66592) | 569 | |
571 | unsigned long count; | 570 | if (m66592->pdata->on_chip) { |
572 | unsigned char *pb; | 571 | unsigned long count; |
573 | int i; | 572 | unsigned char *pb; |
574 | 573 | int i; | |
575 | count = len / 4; | 574 | |
576 | outsl(fifoaddr, buf, count); | 575 | count = len / 4; |
577 | 576 | outsl(fifoaddr, buf, count); | |
578 | if (len & 0x00000003) { | 577 | |
579 | pb = buf + count * 4; | 578 | if (len & 0x00000003) { |
580 | for (i = 0; i < (len & 0x00000003); i++) { | 579 | pb = buf + count * 4; |
581 | if (m66592_read(m66592, M66592_CFBCFG)) /* little */ | 580 | for (i = 0; i < (len & 0x00000003); i++) { |
582 | outb(pb[i], fifoaddr + (3 - i)); | 581 | if (m66592_read(m66592, M66592_CFBCFG)) /* le */ |
583 | else | 582 | outb(pb[i], fifoaddr + (3 - i)); |
584 | outb(pb[i], fifoaddr + i); | 583 | else |
584 | outb(pb[i], fifoaddr + i); | ||
585 | } | ||
586 | } | ||
587 | } else { | ||
588 | unsigned long odd = len & 0x0001; | ||
589 | |||
590 | len = len / 2; | ||
591 | outsw(fifoaddr, buf, len); | ||
592 | if (odd) { | ||
593 | unsigned char *p = buf + len*2; | ||
594 | outb(*p, fifoaddr); | ||
585 | } | 595 | } |
586 | } | 596 | } |
587 | #else | ||
588 | unsigned long odd = len & 0x0001; | ||
589 | |||
590 | len = len / 2; | ||
591 | outsw(fifoaddr, buf, len); | ||
592 | if (odd) { | ||
593 | unsigned char *p = buf + len*2; | ||
594 | outb(*p, fifoaddr); | ||
595 | } | ||
596 | #endif /* #if defined(CONFIG_SUPERH_BUILT_IN_M66592) */ | ||
597 | } | 597 | } |
598 | 598 | ||
599 | static inline void m66592_mdfy(struct m66592 *m66592, u16 val, u16 pat, | 599 | static inline void m66592_mdfy(struct m66592 *m66592, u16 val, u16 pat, |
diff --git a/drivers/usb/gadget/r8a66597-udc.c b/drivers/usb/gadget/r8a66597-udc.c new file mode 100644 index 000000000000..e220fb8091a3 --- /dev/null +++ b/drivers/usb/gadget/r8a66597-udc.c | |||
@@ -0,0 +1,1689 @@ | |||
1 | /* | ||
2 | * R8A66597 UDC (USB gadget) | ||
3 | * | ||
4 | * Copyright (C) 2006-2009 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 | #include <linux/clk.h> | ||
29 | |||
30 | #include <linux/usb/ch9.h> | ||
31 | #include <linux/usb/gadget.h> | ||
32 | |||
33 | #include "r8a66597-udc.h" | ||
34 | |||
35 | #define DRIVER_VERSION "2009-08-18" | ||
36 | |||
37 | static const char udc_name[] = "r8a66597_udc"; | ||
38 | static const char *r8a66597_ep_name[] = { | ||
39 | "ep0", "ep1", "ep2", "ep3", "ep4", "ep5", "ep6", "ep7", | ||
40 | "ep8", "ep9", | ||
41 | }; | ||
42 | |||
43 | static void disable_controller(struct r8a66597 *r8a66597); | ||
44 | static void irq_ep0_write(struct r8a66597_ep *ep, struct r8a66597_request *req); | ||
45 | static void irq_packet_write(struct r8a66597_ep *ep, | ||
46 | struct r8a66597_request *req); | ||
47 | static int r8a66597_queue(struct usb_ep *_ep, struct usb_request *_req, | ||
48 | gfp_t gfp_flags); | ||
49 | |||
50 | static void transfer_complete(struct r8a66597_ep *ep, | ||
51 | struct r8a66597_request *req, int status); | ||
52 | |||
53 | /*-------------------------------------------------------------------------*/ | ||
54 | static inline u16 get_usb_speed(struct r8a66597 *r8a66597) | ||
55 | { | ||
56 | return r8a66597_read(r8a66597, DVSTCTR0) & RHST; | ||
57 | } | ||
58 | |||
59 | static void enable_pipe_irq(struct r8a66597 *r8a66597, u16 pipenum, | ||
60 | unsigned long reg) | ||
61 | { | ||
62 | u16 tmp; | ||
63 | |||
64 | tmp = r8a66597_read(r8a66597, INTENB0); | ||
65 | r8a66597_bclr(r8a66597, BEMPE | NRDYE | BRDYE, | ||
66 | INTENB0); | ||
67 | r8a66597_bset(r8a66597, (1 << pipenum), reg); | ||
68 | r8a66597_write(r8a66597, tmp, INTENB0); | ||
69 | } | ||
70 | |||
71 | static void disable_pipe_irq(struct r8a66597 *r8a66597, u16 pipenum, | ||
72 | unsigned long reg) | ||
73 | { | ||
74 | u16 tmp; | ||
75 | |||
76 | tmp = r8a66597_read(r8a66597, INTENB0); | ||
77 | r8a66597_bclr(r8a66597, BEMPE | NRDYE | BRDYE, | ||
78 | INTENB0); | ||
79 | r8a66597_bclr(r8a66597, (1 << pipenum), reg); | ||
80 | r8a66597_write(r8a66597, tmp, INTENB0); | ||
81 | } | ||
82 | |||
83 | static void r8a66597_usb_connect(struct r8a66597 *r8a66597) | ||
84 | { | ||
85 | r8a66597_bset(r8a66597, CTRE, INTENB0); | ||
86 | r8a66597_bset(r8a66597, BEMPE | BRDYE, INTENB0); | ||
87 | |||
88 | r8a66597_bset(r8a66597, DPRPU, SYSCFG0); | ||
89 | } | ||
90 | |||
91 | static void r8a66597_usb_disconnect(struct r8a66597 *r8a66597) | ||
92 | __releases(r8a66597->lock) | ||
93 | __acquires(r8a66597->lock) | ||
94 | { | ||
95 | r8a66597_bclr(r8a66597, CTRE, INTENB0); | ||
96 | r8a66597_bclr(r8a66597, BEMPE | BRDYE, INTENB0); | ||
97 | r8a66597_bclr(r8a66597, DPRPU, SYSCFG0); | ||
98 | |||
99 | r8a66597->gadget.speed = USB_SPEED_UNKNOWN; | ||
100 | spin_unlock(&r8a66597->lock); | ||
101 | r8a66597->driver->disconnect(&r8a66597->gadget); | ||
102 | spin_lock(&r8a66597->lock); | ||
103 | |||
104 | disable_controller(r8a66597); | ||
105 | INIT_LIST_HEAD(&r8a66597->ep[0].queue); | ||
106 | } | ||
107 | |||
108 | static inline u16 control_reg_get_pid(struct r8a66597 *r8a66597, u16 pipenum) | ||
109 | { | ||
110 | u16 pid = 0; | ||
111 | unsigned long offset; | ||
112 | |||
113 | if (pipenum == 0) | ||
114 | pid = r8a66597_read(r8a66597, DCPCTR) & PID; | ||
115 | else if (pipenum < R8A66597_MAX_NUM_PIPE) { | ||
116 | offset = get_pipectr_addr(pipenum); | ||
117 | pid = r8a66597_read(r8a66597, offset) & PID; | ||
118 | } else | ||
119 | printk(KERN_ERR "unexpect pipe num (%d)\n", pipenum); | ||
120 | |||
121 | return pid; | ||
122 | } | ||
123 | |||
124 | static inline void control_reg_set_pid(struct r8a66597 *r8a66597, u16 pipenum, | ||
125 | u16 pid) | ||
126 | { | ||
127 | unsigned long offset; | ||
128 | |||
129 | if (pipenum == 0) | ||
130 | r8a66597_mdfy(r8a66597, pid, PID, DCPCTR); | ||
131 | else if (pipenum < R8A66597_MAX_NUM_PIPE) { | ||
132 | offset = get_pipectr_addr(pipenum); | ||
133 | r8a66597_mdfy(r8a66597, pid, PID, offset); | ||
134 | } else | ||
135 | printk(KERN_ERR "unexpect pipe num (%d)\n", pipenum); | ||
136 | } | ||
137 | |||
138 | static inline void pipe_start(struct r8a66597 *r8a66597, u16 pipenum) | ||
139 | { | ||
140 | control_reg_set_pid(r8a66597, pipenum, PID_BUF); | ||
141 | } | ||
142 | |||
143 | static inline void pipe_stop(struct r8a66597 *r8a66597, u16 pipenum) | ||
144 | { | ||
145 | control_reg_set_pid(r8a66597, pipenum, PID_NAK); | ||
146 | } | ||
147 | |||
148 | static inline void pipe_stall(struct r8a66597 *r8a66597, u16 pipenum) | ||
149 | { | ||
150 | control_reg_set_pid(r8a66597, pipenum, PID_STALL); | ||
151 | } | ||
152 | |||
153 | static inline u16 control_reg_get(struct r8a66597 *r8a66597, u16 pipenum) | ||
154 | { | ||
155 | u16 ret = 0; | ||
156 | unsigned long offset; | ||
157 | |||
158 | if (pipenum == 0) | ||
159 | ret = r8a66597_read(r8a66597, DCPCTR); | ||
160 | else if (pipenum < R8A66597_MAX_NUM_PIPE) { | ||
161 | offset = get_pipectr_addr(pipenum); | ||
162 | ret = r8a66597_read(r8a66597, offset); | ||
163 | } else | ||
164 | printk(KERN_ERR "unexpect pipe num (%d)\n", pipenum); | ||
165 | |||
166 | return ret; | ||
167 | } | ||
168 | |||
169 | static inline void control_reg_sqclr(struct r8a66597 *r8a66597, u16 pipenum) | ||
170 | { | ||
171 | unsigned long offset; | ||
172 | |||
173 | pipe_stop(r8a66597, pipenum); | ||
174 | |||
175 | if (pipenum == 0) | ||
176 | r8a66597_bset(r8a66597, SQCLR, DCPCTR); | ||
177 | else if (pipenum < R8A66597_MAX_NUM_PIPE) { | ||
178 | offset = get_pipectr_addr(pipenum); | ||
179 | r8a66597_bset(r8a66597, SQCLR, offset); | ||
180 | } else | ||
181 | printk(KERN_ERR "unexpect pipe num(%d)\n", pipenum); | ||
182 | } | ||
183 | |||
184 | static inline int get_buffer_size(struct r8a66597 *r8a66597, u16 pipenum) | ||
185 | { | ||
186 | u16 tmp; | ||
187 | int size; | ||
188 | |||
189 | if (pipenum == 0) { | ||
190 | tmp = r8a66597_read(r8a66597, DCPCFG); | ||
191 | if ((tmp & R8A66597_CNTMD) != 0) | ||
192 | size = 256; | ||
193 | else { | ||
194 | tmp = r8a66597_read(r8a66597, DCPMAXP); | ||
195 | size = tmp & MAXP; | ||
196 | } | ||
197 | } else { | ||
198 | r8a66597_write(r8a66597, pipenum, PIPESEL); | ||
199 | tmp = r8a66597_read(r8a66597, PIPECFG); | ||
200 | if ((tmp & R8A66597_CNTMD) != 0) { | ||
201 | tmp = r8a66597_read(r8a66597, PIPEBUF); | ||
202 | size = ((tmp >> 10) + 1) * 64; | ||
203 | } else { | ||
204 | tmp = r8a66597_read(r8a66597, PIPEMAXP); | ||
205 | size = tmp & MXPS; | ||
206 | } | ||
207 | } | ||
208 | |||
209 | return size; | ||
210 | } | ||
211 | |||
212 | static inline unsigned short mbw_value(struct r8a66597 *r8a66597) | ||
213 | { | ||
214 | if (r8a66597->pdata->on_chip) | ||
215 | return MBW_32; | ||
216 | else | ||
217 | return MBW_16; | ||
218 | } | ||
219 | |||
220 | static inline void pipe_change(struct r8a66597 *r8a66597, u16 pipenum) | ||
221 | { | ||
222 | struct r8a66597_ep *ep = r8a66597->pipenum2ep[pipenum]; | ||
223 | |||
224 | if (ep->use_dma) | ||
225 | return; | ||
226 | |||
227 | r8a66597_mdfy(r8a66597, pipenum, CURPIPE, ep->fifosel); | ||
228 | |||
229 | ndelay(450); | ||
230 | |||
231 | r8a66597_bset(r8a66597, mbw_value(r8a66597), ep->fifosel); | ||
232 | } | ||
233 | |||
234 | static int pipe_buffer_setting(struct r8a66597 *r8a66597, | ||
235 | struct r8a66597_pipe_info *info) | ||
236 | { | ||
237 | u16 bufnum = 0, buf_bsize = 0; | ||
238 | u16 pipecfg = 0; | ||
239 | |||
240 | if (info->pipe == 0) | ||
241 | return -EINVAL; | ||
242 | |||
243 | r8a66597_write(r8a66597, info->pipe, PIPESEL); | ||
244 | |||
245 | if (info->dir_in) | ||
246 | pipecfg |= R8A66597_DIR; | ||
247 | pipecfg |= info->type; | ||
248 | pipecfg |= info->epnum; | ||
249 | switch (info->type) { | ||
250 | case R8A66597_INT: | ||
251 | bufnum = 4 + (info->pipe - R8A66597_BASE_PIPENUM_INT); | ||
252 | buf_bsize = 0; | ||
253 | break; | ||
254 | case R8A66597_BULK: | ||
255 | /* isochronous pipes may be used as bulk pipes */ | ||
256 | if (info->pipe > R8A66597_BASE_PIPENUM_BULK) | ||
257 | bufnum = info->pipe - R8A66597_BASE_PIPENUM_BULK; | ||
258 | else | ||
259 | bufnum = info->pipe - R8A66597_BASE_PIPENUM_ISOC; | ||
260 | |||
261 | bufnum = R8A66597_BASE_BUFNUM + (bufnum * 16); | ||
262 | buf_bsize = 7; | ||
263 | pipecfg |= R8A66597_DBLB; | ||
264 | if (!info->dir_in) | ||
265 | pipecfg |= R8A66597_SHTNAK; | ||
266 | break; | ||
267 | case R8A66597_ISO: | ||
268 | bufnum = R8A66597_BASE_BUFNUM + | ||
269 | (info->pipe - R8A66597_BASE_PIPENUM_ISOC) * 16; | ||
270 | buf_bsize = 7; | ||
271 | break; | ||
272 | } | ||
273 | |||
274 | if (buf_bsize && ((bufnum + 16) >= R8A66597_MAX_BUFNUM)) { | ||
275 | pr_err(KERN_ERR "r8a66597 pipe memory is insufficient\n"); | ||
276 | return -ENOMEM; | ||
277 | } | ||
278 | |||
279 | r8a66597_write(r8a66597, pipecfg, PIPECFG); | ||
280 | r8a66597_write(r8a66597, (buf_bsize << 10) | (bufnum), PIPEBUF); | ||
281 | r8a66597_write(r8a66597, info->maxpacket, PIPEMAXP); | ||
282 | if (info->interval) | ||
283 | info->interval--; | ||
284 | r8a66597_write(r8a66597, info->interval, PIPEPERI); | ||
285 | |||
286 | return 0; | ||
287 | } | ||
288 | |||
289 | static void pipe_buffer_release(struct r8a66597 *r8a66597, | ||
290 | struct r8a66597_pipe_info *info) | ||
291 | { | ||
292 | if (info->pipe == 0) | ||
293 | return; | ||
294 | |||
295 | if (is_bulk_pipe(info->pipe)) | ||
296 | r8a66597->bulk--; | ||
297 | else if (is_interrupt_pipe(info->pipe)) | ||
298 | r8a66597->interrupt--; | ||
299 | else if (is_isoc_pipe(info->pipe)) { | ||
300 | r8a66597->isochronous--; | ||
301 | if (info->type == R8A66597_BULK) | ||
302 | r8a66597->bulk--; | ||
303 | } else | ||
304 | printk(KERN_ERR "ep_release: unexpect pipenum (%d)\n", | ||
305 | info->pipe); | ||
306 | } | ||
307 | |||
308 | static void pipe_initialize(struct r8a66597_ep *ep) | ||
309 | { | ||
310 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
311 | |||
312 | r8a66597_mdfy(r8a66597, 0, CURPIPE, ep->fifosel); | ||
313 | |||
314 | r8a66597_write(r8a66597, ACLRM, ep->pipectr); | ||
315 | r8a66597_write(r8a66597, 0, ep->pipectr); | ||
316 | r8a66597_write(r8a66597, SQCLR, ep->pipectr); | ||
317 | if (ep->use_dma) { | ||
318 | r8a66597_mdfy(r8a66597, ep->pipenum, CURPIPE, ep->fifosel); | ||
319 | |||
320 | ndelay(450); | ||
321 | |||
322 | r8a66597_bset(r8a66597, mbw_value(r8a66597), ep->fifosel); | ||
323 | } | ||
324 | } | ||
325 | |||
326 | static void r8a66597_ep_setting(struct r8a66597 *r8a66597, | ||
327 | struct r8a66597_ep *ep, | ||
328 | const struct usb_endpoint_descriptor *desc, | ||
329 | u16 pipenum, int dma) | ||
330 | { | ||
331 | ep->use_dma = 0; | ||
332 | ep->fifoaddr = CFIFO; | ||
333 | ep->fifosel = CFIFOSEL; | ||
334 | ep->fifoctr = CFIFOCTR; | ||
335 | ep->fifotrn = 0; | ||
336 | |||
337 | ep->pipectr = get_pipectr_addr(pipenum); | ||
338 | ep->pipenum = pipenum; | ||
339 | ep->ep.maxpacket = le16_to_cpu(desc->wMaxPacketSize); | ||
340 | r8a66597->pipenum2ep[pipenum] = ep; | ||
341 | r8a66597->epaddr2ep[desc->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK] | ||
342 | = ep; | ||
343 | INIT_LIST_HEAD(&ep->queue); | ||
344 | } | ||
345 | |||
346 | static void r8a66597_ep_release(struct r8a66597_ep *ep) | ||
347 | { | ||
348 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
349 | u16 pipenum = ep->pipenum; | ||
350 | |||
351 | if (pipenum == 0) | ||
352 | return; | ||
353 | |||
354 | if (ep->use_dma) | ||
355 | r8a66597->num_dma--; | ||
356 | ep->pipenum = 0; | ||
357 | ep->busy = 0; | ||
358 | ep->use_dma = 0; | ||
359 | } | ||
360 | |||
361 | static int alloc_pipe_config(struct r8a66597_ep *ep, | ||
362 | const struct usb_endpoint_descriptor *desc) | ||
363 | { | ||
364 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
365 | struct r8a66597_pipe_info info; | ||
366 | int dma = 0; | ||
367 | unsigned char *counter; | ||
368 | int ret; | ||
369 | |||
370 | ep->desc = desc; | ||
371 | |||
372 | if (ep->pipenum) /* already allocated pipe */ | ||
373 | return 0; | ||
374 | |||
375 | switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) { | ||
376 | case USB_ENDPOINT_XFER_BULK: | ||
377 | if (r8a66597->bulk >= R8A66597_MAX_NUM_BULK) { | ||
378 | if (r8a66597->isochronous >= R8A66597_MAX_NUM_ISOC) { | ||
379 | printk(KERN_ERR "bulk pipe is insufficient\n"); | ||
380 | return -ENODEV; | ||
381 | } else { | ||
382 | info.pipe = R8A66597_BASE_PIPENUM_ISOC | ||
383 | + r8a66597->isochronous; | ||
384 | counter = &r8a66597->isochronous; | ||
385 | } | ||
386 | } else { | ||
387 | info.pipe = R8A66597_BASE_PIPENUM_BULK + r8a66597->bulk; | ||
388 | counter = &r8a66597->bulk; | ||
389 | } | ||
390 | info.type = R8A66597_BULK; | ||
391 | dma = 1; | ||
392 | break; | ||
393 | case USB_ENDPOINT_XFER_INT: | ||
394 | if (r8a66597->interrupt >= R8A66597_MAX_NUM_INT) { | ||
395 | printk(KERN_ERR "interrupt pipe is insufficient\n"); | ||
396 | return -ENODEV; | ||
397 | } | ||
398 | info.pipe = R8A66597_BASE_PIPENUM_INT + r8a66597->interrupt; | ||
399 | info.type = R8A66597_INT; | ||
400 | counter = &r8a66597->interrupt; | ||
401 | break; | ||
402 | case USB_ENDPOINT_XFER_ISOC: | ||
403 | if (r8a66597->isochronous >= R8A66597_MAX_NUM_ISOC) { | ||
404 | printk(KERN_ERR "isochronous pipe is insufficient\n"); | ||
405 | return -ENODEV; | ||
406 | } | ||
407 | info.pipe = R8A66597_BASE_PIPENUM_ISOC + r8a66597->isochronous; | ||
408 | info.type = R8A66597_ISO; | ||
409 | counter = &r8a66597->isochronous; | ||
410 | break; | ||
411 | default: | ||
412 | printk(KERN_ERR "unexpect xfer type\n"); | ||
413 | return -EINVAL; | ||
414 | } | ||
415 | ep->type = info.type; | ||
416 | |||
417 | info.epnum = desc->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK; | ||
418 | info.maxpacket = le16_to_cpu(desc->wMaxPacketSize); | ||
419 | info.interval = desc->bInterval; | ||
420 | if (desc->bEndpointAddress & USB_ENDPOINT_DIR_MASK) | ||
421 | info.dir_in = 1; | ||
422 | else | ||
423 | info.dir_in = 0; | ||
424 | |||
425 | ret = pipe_buffer_setting(r8a66597, &info); | ||
426 | if (ret < 0) { | ||
427 | printk(KERN_ERR "pipe_buffer_setting fail\n"); | ||
428 | return ret; | ||
429 | } | ||
430 | |||
431 | (*counter)++; | ||
432 | if ((counter == &r8a66597->isochronous) && info.type == R8A66597_BULK) | ||
433 | r8a66597->bulk++; | ||
434 | |||
435 | r8a66597_ep_setting(r8a66597, ep, desc, info.pipe, dma); | ||
436 | pipe_initialize(ep); | ||
437 | |||
438 | return 0; | ||
439 | } | ||
440 | |||
441 | static int free_pipe_config(struct r8a66597_ep *ep) | ||
442 | { | ||
443 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
444 | struct r8a66597_pipe_info info; | ||
445 | |||
446 | info.pipe = ep->pipenum; | ||
447 | info.type = ep->type; | ||
448 | pipe_buffer_release(r8a66597, &info); | ||
449 | r8a66597_ep_release(ep); | ||
450 | |||
451 | return 0; | ||
452 | } | ||
453 | |||
454 | /*-------------------------------------------------------------------------*/ | ||
455 | static void pipe_irq_enable(struct r8a66597 *r8a66597, u16 pipenum) | ||
456 | { | ||
457 | enable_irq_ready(r8a66597, pipenum); | ||
458 | enable_irq_nrdy(r8a66597, pipenum); | ||
459 | } | ||
460 | |||
461 | static void pipe_irq_disable(struct r8a66597 *r8a66597, u16 pipenum) | ||
462 | { | ||
463 | disable_irq_ready(r8a66597, pipenum); | ||
464 | disable_irq_nrdy(r8a66597, pipenum); | ||
465 | } | ||
466 | |||
467 | /* if complete is true, gadget driver complete function is not call */ | ||
468 | static void control_end(struct r8a66597 *r8a66597, unsigned ccpl) | ||
469 | { | ||
470 | r8a66597->ep[0].internal_ccpl = ccpl; | ||
471 | pipe_start(r8a66597, 0); | ||
472 | r8a66597_bset(r8a66597, CCPL, DCPCTR); | ||
473 | } | ||
474 | |||
475 | static void start_ep0_write(struct r8a66597_ep *ep, | ||
476 | struct r8a66597_request *req) | ||
477 | { | ||
478 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
479 | |||
480 | pipe_change(r8a66597, ep->pipenum); | ||
481 | r8a66597_mdfy(r8a66597, ISEL, (ISEL | CURPIPE), CFIFOSEL); | ||
482 | r8a66597_write(r8a66597, BCLR, ep->fifoctr); | ||
483 | if (req->req.length == 0) { | ||
484 | r8a66597_bset(r8a66597, BVAL, ep->fifoctr); | ||
485 | pipe_start(r8a66597, 0); | ||
486 | transfer_complete(ep, req, 0); | ||
487 | } else { | ||
488 | r8a66597_write(r8a66597, ~BEMP0, BEMPSTS); | ||
489 | irq_ep0_write(ep, req); | ||
490 | } | ||
491 | } | ||
492 | |||
493 | static void start_packet_write(struct r8a66597_ep *ep, | ||
494 | struct r8a66597_request *req) | ||
495 | { | ||
496 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
497 | u16 tmp; | ||
498 | |||
499 | pipe_change(r8a66597, ep->pipenum); | ||
500 | disable_irq_empty(r8a66597, ep->pipenum); | ||
501 | pipe_start(r8a66597, ep->pipenum); | ||
502 | |||
503 | tmp = r8a66597_read(r8a66597, ep->fifoctr); | ||
504 | if (unlikely((tmp & FRDY) == 0)) | ||
505 | pipe_irq_enable(r8a66597, ep->pipenum); | ||
506 | else | ||
507 | irq_packet_write(ep, req); | ||
508 | } | ||
509 | |||
510 | static void start_packet_read(struct r8a66597_ep *ep, | ||
511 | struct r8a66597_request *req) | ||
512 | { | ||
513 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
514 | u16 pipenum = ep->pipenum; | ||
515 | |||
516 | if (ep->pipenum == 0) { | ||
517 | r8a66597_mdfy(r8a66597, 0, (ISEL | CURPIPE), CFIFOSEL); | ||
518 | r8a66597_write(r8a66597, BCLR, ep->fifoctr); | ||
519 | pipe_start(r8a66597, pipenum); | ||
520 | pipe_irq_enable(r8a66597, pipenum); | ||
521 | } else { | ||
522 | if (ep->use_dma) { | ||
523 | r8a66597_bset(r8a66597, TRCLR, ep->fifosel); | ||
524 | pipe_change(r8a66597, pipenum); | ||
525 | r8a66597_bset(r8a66597, TRENB, ep->fifosel); | ||
526 | r8a66597_write(r8a66597, | ||
527 | (req->req.length + ep->ep.maxpacket - 1) | ||
528 | / ep->ep.maxpacket, | ||
529 | ep->fifotrn); | ||
530 | } | ||
531 | pipe_start(r8a66597, pipenum); /* trigger once */ | ||
532 | pipe_irq_enable(r8a66597, pipenum); | ||
533 | } | ||
534 | } | ||
535 | |||
536 | static void start_packet(struct r8a66597_ep *ep, struct r8a66597_request *req) | ||
537 | { | ||
538 | if (ep->desc->bEndpointAddress & USB_DIR_IN) | ||
539 | start_packet_write(ep, req); | ||
540 | else | ||
541 | start_packet_read(ep, req); | ||
542 | } | ||
543 | |||
544 | static void start_ep0(struct r8a66597_ep *ep, struct r8a66597_request *req) | ||
545 | { | ||
546 | u16 ctsq; | ||
547 | |||
548 | ctsq = r8a66597_read(ep->r8a66597, INTSTS0) & CTSQ; | ||
549 | |||
550 | switch (ctsq) { | ||
551 | case CS_RDDS: | ||
552 | start_ep0_write(ep, req); | ||
553 | break; | ||
554 | case CS_WRDS: | ||
555 | start_packet_read(ep, req); | ||
556 | break; | ||
557 | |||
558 | case CS_WRND: | ||
559 | control_end(ep->r8a66597, 0); | ||
560 | break; | ||
561 | default: | ||
562 | printk(KERN_ERR "start_ep0: unexpect ctsq(%x)\n", ctsq); | ||
563 | break; | ||
564 | } | ||
565 | } | ||
566 | |||
567 | static void init_controller(struct r8a66597 *r8a66597) | ||
568 | { | ||
569 | u16 vif = r8a66597->pdata->vif ? LDRV : 0; | ||
570 | u16 irq_sense = r8a66597->irq_sense_low ? INTL : 0; | ||
571 | u16 endian = r8a66597->pdata->endian ? BIGEND : 0; | ||
572 | |||
573 | if (r8a66597->pdata->on_chip) { | ||
574 | r8a66597_bset(r8a66597, 0x04, SYSCFG1); | ||
575 | r8a66597_bset(r8a66597, HSE, SYSCFG0); | ||
576 | |||
577 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); | ||
578 | r8a66597_bclr(r8a66597, DPRPU, SYSCFG0); | ||
579 | r8a66597_bset(r8a66597, USBE, SYSCFG0); | ||
580 | |||
581 | r8a66597_bset(r8a66597, SCKE, SYSCFG0); | ||
582 | |||
583 | r8a66597_bset(r8a66597, irq_sense, INTENB1); | ||
584 | r8a66597_write(r8a66597, BURST | CPU_ADR_RD_WR, | ||
585 | DMA0CFG); | ||
586 | } else { | ||
587 | r8a66597_bset(r8a66597, vif | endian, PINCFG); | ||
588 | r8a66597_bset(r8a66597, HSE, SYSCFG0); /* High spd */ | ||
589 | r8a66597_mdfy(r8a66597, get_xtal_from_pdata(r8a66597->pdata), | ||
590 | XTAL, SYSCFG0); | ||
591 | |||
592 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); | ||
593 | r8a66597_bclr(r8a66597, DPRPU, SYSCFG0); | ||
594 | r8a66597_bset(r8a66597, USBE, SYSCFG0); | ||
595 | |||
596 | r8a66597_bset(r8a66597, XCKE, SYSCFG0); | ||
597 | |||
598 | msleep(3); | ||
599 | |||
600 | r8a66597_bset(r8a66597, PLLC, SYSCFG0); | ||
601 | |||
602 | msleep(1); | ||
603 | |||
604 | r8a66597_bset(r8a66597, SCKE, SYSCFG0); | ||
605 | |||
606 | r8a66597_bset(r8a66597, irq_sense, INTENB1); | ||
607 | r8a66597_write(r8a66597, BURST | CPU_ADR_RD_WR, | ||
608 | DMA0CFG); | ||
609 | } | ||
610 | } | ||
611 | |||
612 | static void disable_controller(struct r8a66597 *r8a66597) | ||
613 | { | ||
614 | if (r8a66597->pdata->on_chip) { | ||
615 | r8a66597_bset(r8a66597, SCKE, SYSCFG0); | ||
616 | |||
617 | /* disable interrupts */ | ||
618 | r8a66597_write(r8a66597, 0, INTENB0); | ||
619 | r8a66597_write(r8a66597, 0, INTENB1); | ||
620 | r8a66597_write(r8a66597, 0, BRDYENB); | ||
621 | r8a66597_write(r8a66597, 0, BEMPENB); | ||
622 | r8a66597_write(r8a66597, 0, NRDYENB); | ||
623 | |||
624 | /* clear status */ | ||
625 | r8a66597_write(r8a66597, 0, BRDYSTS); | ||
626 | r8a66597_write(r8a66597, 0, NRDYSTS); | ||
627 | r8a66597_write(r8a66597, 0, BEMPSTS); | ||
628 | |||
629 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); | ||
630 | r8a66597_bclr(r8a66597, SCKE, SYSCFG0); | ||
631 | |||
632 | } else { | ||
633 | r8a66597_bclr(r8a66597, SCKE, SYSCFG0); | ||
634 | udelay(1); | ||
635 | r8a66597_bclr(r8a66597, PLLC, SYSCFG0); | ||
636 | udelay(1); | ||
637 | udelay(1); | ||
638 | r8a66597_bclr(r8a66597, XCKE, SYSCFG0); | ||
639 | } | ||
640 | } | ||
641 | |||
642 | static void r8a66597_start_xclock(struct r8a66597 *r8a66597) | ||
643 | { | ||
644 | u16 tmp; | ||
645 | |||
646 | if (!r8a66597->pdata->on_chip) { | ||
647 | tmp = r8a66597_read(r8a66597, SYSCFG0); | ||
648 | if (!(tmp & XCKE)) | ||
649 | r8a66597_bset(r8a66597, XCKE, SYSCFG0); | ||
650 | } | ||
651 | } | ||
652 | |||
653 | static struct r8a66597_request *get_request_from_ep(struct r8a66597_ep *ep) | ||
654 | { | ||
655 | return list_entry(ep->queue.next, struct r8a66597_request, queue); | ||
656 | } | ||
657 | |||
658 | /*-------------------------------------------------------------------------*/ | ||
659 | static void transfer_complete(struct r8a66597_ep *ep, | ||
660 | struct r8a66597_request *req, int status) | ||
661 | __releases(r8a66597->lock) | ||
662 | __acquires(r8a66597->lock) | ||
663 | { | ||
664 | int restart = 0; | ||
665 | |||
666 | if (unlikely(ep->pipenum == 0)) { | ||
667 | if (ep->internal_ccpl) { | ||
668 | ep->internal_ccpl = 0; | ||
669 | return; | ||
670 | } | ||
671 | } | ||
672 | |||
673 | list_del_init(&req->queue); | ||
674 | if (ep->r8a66597->gadget.speed == USB_SPEED_UNKNOWN) | ||
675 | req->req.status = -ESHUTDOWN; | ||
676 | else | ||
677 | req->req.status = status; | ||
678 | |||
679 | if (!list_empty(&ep->queue)) | ||
680 | restart = 1; | ||
681 | |||
682 | spin_unlock(&ep->r8a66597->lock); | ||
683 | req->req.complete(&ep->ep, &req->req); | ||
684 | spin_lock(&ep->r8a66597->lock); | ||
685 | |||
686 | if (restart) { | ||
687 | req = get_request_from_ep(ep); | ||
688 | if (ep->desc) | ||
689 | start_packet(ep, req); | ||
690 | } | ||
691 | } | ||
692 | |||
693 | static void irq_ep0_write(struct r8a66597_ep *ep, struct r8a66597_request *req) | ||
694 | { | ||
695 | int i; | ||
696 | u16 tmp; | ||
697 | unsigned bufsize; | ||
698 | size_t size; | ||
699 | void *buf; | ||
700 | u16 pipenum = ep->pipenum; | ||
701 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
702 | |||
703 | pipe_change(r8a66597, pipenum); | ||
704 | r8a66597_bset(r8a66597, ISEL, ep->fifosel); | ||
705 | |||
706 | i = 0; | ||
707 | do { | ||
708 | tmp = r8a66597_read(r8a66597, ep->fifoctr); | ||
709 | if (i++ > 100000) { | ||
710 | printk(KERN_ERR "pipe0 is busy. maybe cpu i/o bus" | ||
711 | "conflict. please power off this controller."); | ||
712 | return; | ||
713 | } | ||
714 | ndelay(1); | ||
715 | } while ((tmp & FRDY) == 0); | ||
716 | |||
717 | /* prepare parameters */ | ||
718 | bufsize = get_buffer_size(r8a66597, pipenum); | ||
719 | buf = req->req.buf + req->req.actual; | ||
720 | size = min(bufsize, req->req.length - req->req.actual); | ||
721 | |||
722 | /* write fifo */ | ||
723 | if (req->req.buf) { | ||
724 | if (size > 0) | ||
725 | r8a66597_write_fifo(r8a66597, ep->fifoaddr, buf, size); | ||
726 | if ((size == 0) || ((size % ep->ep.maxpacket) != 0)) | ||
727 | r8a66597_bset(r8a66597, BVAL, ep->fifoctr); | ||
728 | } | ||
729 | |||
730 | /* update parameters */ | ||
731 | req->req.actual += size; | ||
732 | |||
733 | /* check transfer finish */ | ||
734 | if ((!req->req.zero && (req->req.actual == req->req.length)) | ||
735 | || (size % ep->ep.maxpacket) | ||
736 | || (size == 0)) { | ||
737 | disable_irq_ready(r8a66597, pipenum); | ||
738 | disable_irq_empty(r8a66597, pipenum); | ||
739 | } else { | ||
740 | disable_irq_ready(r8a66597, pipenum); | ||
741 | enable_irq_empty(r8a66597, pipenum); | ||
742 | } | ||
743 | pipe_start(r8a66597, pipenum); | ||
744 | } | ||
745 | |||
746 | static void irq_packet_write(struct r8a66597_ep *ep, | ||
747 | struct r8a66597_request *req) | ||
748 | { | ||
749 | u16 tmp; | ||
750 | unsigned bufsize; | ||
751 | size_t size; | ||
752 | void *buf; | ||
753 | u16 pipenum = ep->pipenum; | ||
754 | struct r8a66597 *r8a66597 = ep->r8a66597; | ||
755 | |||
756 | pipe_change(r8a66597, pipenum); | ||
757 | tmp = r8a66597_read(r8a66597, ep->fifoctr); | ||
758 | if (unlikely((tmp & FRDY) == 0)) { | ||
759 | pipe_stop(r8a66597, pipenum); | ||
760 | pipe_irq_disable(r8a66597, pipenum); | ||
761 | printk(KERN_ERR "write fifo not ready. pipnum=%d\n", pipenum); | ||
762 | return; | ||
763 | } | ||
764 | |||
765 | /* prepare parameters */ | ||
766 | bufsize = get_buffer_size(r8a66597, pipenum); | ||
767 | buf = req->req.buf + req->req.actual; | ||
768 | size = min(bufsize, req->req.length - req->req.actual); | ||
769 | |||
770 | /* write fifo */ | ||
771 | if (req->req.buf) { | ||
772 | r8a66597_write_fifo(r8a66597, ep->fifoaddr, buf, size); | ||
773 | if ((size == 0) | ||
774 | || ((size % ep->ep.maxpacket) != 0) | ||
775 | || ((bufsize != ep->ep.maxpacket) | ||
776 | && (bufsize > size))) | ||
777 | r8a66597_bset(r8a66597, BVAL, ep->fifoctr); | ||
778 | } | ||
779 | |||
780 | /* update parameters */ | ||
781 | req->req.actual += size; | ||
782 | /* check transfer finish */ | ||
783 | if ((!req->req.zero && (req->req.actual == req->req.length)) | ||
784 | || (size % ep->ep.maxpacket) | ||
785 | || (size == 0)) { | ||
786 | disable_irq_ready(r8a66597, pipenum); | ||
787 | enable_irq_empty(r8a66597, pipenum); | ||
788 | } else { | ||
789 | disable_irq_empty(r8a66597, pipenum); | ||
790 | pipe_irq_enable(r8a66597, pipenum); | ||
791 | } | ||
792 | } | ||
793 | |||
794 | static void irq_packet_read(struct r8a66597_ep *ep, | ||
795 | struct r8a66597_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 r8a66597 *r8a66597 = ep->r8a66597; | ||
803 | int finish = 0; | ||
804 | |||
805 | pipe_change(r8a66597, pipenum); | ||
806 | tmp = r8a66597_read(r8a66597, ep->fifoctr); | ||
807 | if (unlikely((tmp & FRDY) == 0)) { | ||
808 | req->req.status = -EPIPE; | ||
809 | pipe_stop(r8a66597, pipenum); | ||
810 | pipe_irq_disable(r8a66597, pipenum); | ||
811 | printk(KERN_ERR "read fifo not ready"); | ||
812 | return; | ||
813 | } | ||
814 | |||
815 | /* prepare parameters */ | ||
816 | rcv_len = tmp & DTLN; | ||
817 | bufsize = get_buffer_size(r8a66597, 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(r8a66597, pipenum); | ||
834 | pipe_irq_disable(r8a66597, pipenum); | ||
835 | finish = 1; | ||
836 | } | ||
837 | |||
838 | /* read fifo */ | ||
839 | if (req->req.buf) { | ||
840 | if (size == 0) | ||
841 | r8a66597_write(r8a66597, BCLR, ep->fifoctr); | ||
842 | else | ||
843 | r8a66597_read_fifo(r8a66597, ep->fifoaddr, buf, size); | ||
844 | |||
845 | } | ||
846 | |||
847 | if ((ep->pipenum != 0) && finish) | ||
848 | transfer_complete(ep, req, 0); | ||
849 | } | ||
850 | |||
851 | static void irq_pipe_ready(struct r8a66597 *r8a66597, u16 status, u16 enb) | ||
852 | { | ||
853 | u16 check; | ||
854 | u16 pipenum; | ||
855 | struct r8a66597_ep *ep; | ||
856 | struct r8a66597_request *req; | ||
857 | |||
858 | if ((status & BRDY0) && (enb & BRDY0)) { | ||
859 | r8a66597_write(r8a66597, ~BRDY0, BRDYSTS); | ||
860 | r8a66597_mdfy(r8a66597, 0, CURPIPE, CFIFOSEL); | ||
861 | |||
862 | ep = &r8a66597->ep[0]; | ||
863 | req = get_request_from_ep(ep); | ||
864 | irq_packet_read(ep, req); | ||
865 | } else { | ||
866 | for (pipenum = 1; pipenum < R8A66597_MAX_NUM_PIPE; pipenum++) { | ||
867 | check = 1 << pipenum; | ||
868 | if ((status & check) && (enb & check)) { | ||
869 | r8a66597_write(r8a66597, ~check, BRDYSTS); | ||
870 | ep = r8a66597->pipenum2ep[pipenum]; | ||
871 | req = get_request_from_ep(ep); | ||
872 | if (ep->desc->bEndpointAddress & USB_DIR_IN) | ||
873 | irq_packet_write(ep, req); | ||
874 | else | ||
875 | irq_packet_read(ep, req); | ||
876 | } | ||
877 | } | ||
878 | } | ||
879 | } | ||
880 | |||
881 | static void irq_pipe_empty(struct r8a66597 *r8a66597, u16 status, u16 enb) | ||
882 | { | ||
883 | u16 tmp; | ||
884 | u16 check; | ||
885 | u16 pipenum; | ||
886 | struct r8a66597_ep *ep; | ||
887 | struct r8a66597_request *req; | ||
888 | |||
889 | if ((status & BEMP0) && (enb & BEMP0)) { | ||
890 | r8a66597_write(r8a66597, ~BEMP0, BEMPSTS); | ||
891 | |||
892 | ep = &r8a66597->ep[0]; | ||
893 | req = get_request_from_ep(ep); | ||
894 | irq_ep0_write(ep, req); | ||
895 | } else { | ||
896 | for (pipenum = 1; pipenum < R8A66597_MAX_NUM_PIPE; pipenum++) { | ||
897 | check = 1 << pipenum; | ||
898 | if ((status & check) && (enb & check)) { | ||
899 | r8a66597_write(r8a66597, ~check, BEMPSTS); | ||
900 | tmp = control_reg_get(r8a66597, pipenum); | ||
901 | if ((tmp & INBUFM) == 0) { | ||
902 | disable_irq_empty(r8a66597, pipenum); | ||
903 | pipe_irq_disable(r8a66597, pipenum); | ||
904 | pipe_stop(r8a66597, pipenum); | ||
905 | ep = r8a66597->pipenum2ep[pipenum]; | ||
906 | req = get_request_from_ep(ep); | ||
907 | if (!list_empty(&ep->queue)) | ||
908 | transfer_complete(ep, req, 0); | ||
909 | } | ||
910 | } | ||
911 | } | ||
912 | } | ||
913 | } | ||
914 | |||
915 | static void get_status(struct r8a66597 *r8a66597, struct usb_ctrlrequest *ctrl) | ||
916 | __releases(r8a66597->lock) | ||
917 | __acquires(r8a66597->lock) | ||
918 | { | ||
919 | struct r8a66597_ep *ep; | ||
920 | u16 pid; | ||
921 | u16 status = 0; | ||
922 | u16 w_index = le16_to_cpu(ctrl->wIndex); | ||
923 | |||
924 | switch (ctrl->bRequestType & USB_RECIP_MASK) { | ||
925 | case USB_RECIP_DEVICE: | ||
926 | status = 1 << USB_DEVICE_SELF_POWERED; | ||
927 | break; | ||
928 | case USB_RECIP_INTERFACE: | ||
929 | status = 0; | ||
930 | break; | ||
931 | case USB_RECIP_ENDPOINT: | ||
932 | ep = r8a66597->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK]; | ||
933 | pid = control_reg_get_pid(r8a66597, ep->pipenum); | ||
934 | if (pid == PID_STALL) | ||
935 | status = 1 << USB_ENDPOINT_HALT; | ||
936 | else | ||
937 | status = 0; | ||
938 | break; | ||
939 | default: | ||
940 | pipe_stall(r8a66597, 0); | ||
941 | return; /* exit */ | ||
942 | } | ||
943 | |||
944 | r8a66597->ep0_data = cpu_to_le16(status); | ||
945 | r8a66597->ep0_req->buf = &r8a66597->ep0_data; | ||
946 | r8a66597->ep0_req->length = 2; | ||
947 | /* AV: what happens if we get called again before that gets through? */ | ||
948 | spin_unlock(&r8a66597->lock); | ||
949 | r8a66597_queue(r8a66597->gadget.ep0, r8a66597->ep0_req, GFP_KERNEL); | ||
950 | spin_lock(&r8a66597->lock); | ||
951 | } | ||
952 | |||
953 | static void clear_feature(struct r8a66597 *r8a66597, | ||
954 | struct usb_ctrlrequest *ctrl) | ||
955 | { | ||
956 | switch (ctrl->bRequestType & USB_RECIP_MASK) { | ||
957 | case USB_RECIP_DEVICE: | ||
958 | control_end(r8a66597, 1); | ||
959 | break; | ||
960 | case USB_RECIP_INTERFACE: | ||
961 | control_end(r8a66597, 1); | ||
962 | break; | ||
963 | case USB_RECIP_ENDPOINT: { | ||
964 | struct r8a66597_ep *ep; | ||
965 | struct r8a66597_request *req; | ||
966 | u16 w_index = le16_to_cpu(ctrl->wIndex); | ||
967 | |||
968 | ep = r8a66597->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK]; | ||
969 | if (!ep->wedge) { | ||
970 | pipe_stop(r8a66597, ep->pipenum); | ||
971 | control_reg_sqclr(r8a66597, ep->pipenum); | ||
972 | spin_unlock(&r8a66597->lock); | ||
973 | usb_ep_clear_halt(&ep->ep); | ||
974 | spin_lock(&r8a66597->lock); | ||
975 | } | ||
976 | |||
977 | control_end(r8a66597, 1); | ||
978 | |||
979 | req = get_request_from_ep(ep); | ||
980 | if (ep->busy) { | ||
981 | ep->busy = 0; | ||
982 | if (list_empty(&ep->queue)) | ||
983 | break; | ||
984 | start_packet(ep, req); | ||
985 | } else if (!list_empty(&ep->queue)) | ||
986 | pipe_start(r8a66597, ep->pipenum); | ||
987 | } | ||
988 | break; | ||
989 | default: | ||
990 | pipe_stall(r8a66597, 0); | ||
991 | break; | ||
992 | } | ||
993 | } | ||
994 | |||
995 | static void set_feature(struct r8a66597 *r8a66597, struct usb_ctrlrequest *ctrl) | ||
996 | { | ||
997 | |||
998 | switch (ctrl->bRequestType & USB_RECIP_MASK) { | ||
999 | case USB_RECIP_DEVICE: | ||
1000 | control_end(r8a66597, 1); | ||
1001 | break; | ||
1002 | case USB_RECIP_INTERFACE: | ||
1003 | control_end(r8a66597, 1); | ||
1004 | break; | ||
1005 | case USB_RECIP_ENDPOINT: { | ||
1006 | struct r8a66597_ep *ep; | ||
1007 | u16 w_index = le16_to_cpu(ctrl->wIndex); | ||
1008 | |||
1009 | ep = r8a66597->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK]; | ||
1010 | pipe_stall(r8a66597, ep->pipenum); | ||
1011 | |||
1012 | control_end(r8a66597, 1); | ||
1013 | } | ||
1014 | break; | ||
1015 | default: | ||
1016 | pipe_stall(r8a66597, 0); | ||
1017 | break; | ||
1018 | } | ||
1019 | } | ||
1020 | |||
1021 | /* if return value is true, call class driver's setup() */ | ||
1022 | static int setup_packet(struct r8a66597 *r8a66597, struct usb_ctrlrequest *ctrl) | ||
1023 | { | ||
1024 | u16 *p = (u16 *)ctrl; | ||
1025 | unsigned long offset = USBREQ; | ||
1026 | int i, ret = 0; | ||
1027 | |||
1028 | /* read fifo */ | ||
1029 | r8a66597_write(r8a66597, ~VALID, INTSTS0); | ||
1030 | |||
1031 | for (i = 0; i < 4; i++) | ||
1032 | p[i] = r8a66597_read(r8a66597, offset + i*2); | ||
1033 | |||
1034 | /* check request */ | ||
1035 | if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) { | ||
1036 | switch (ctrl->bRequest) { | ||
1037 | case USB_REQ_GET_STATUS: | ||
1038 | get_status(r8a66597, ctrl); | ||
1039 | break; | ||
1040 | case USB_REQ_CLEAR_FEATURE: | ||
1041 | clear_feature(r8a66597, ctrl); | ||
1042 | break; | ||
1043 | case USB_REQ_SET_FEATURE: | ||
1044 | set_feature(r8a66597, ctrl); | ||
1045 | break; | ||
1046 | default: | ||
1047 | ret = 1; | ||
1048 | break; | ||
1049 | } | ||
1050 | } else | ||
1051 | ret = 1; | ||
1052 | return ret; | ||
1053 | } | ||
1054 | |||
1055 | static void r8a66597_update_usb_speed(struct r8a66597 *r8a66597) | ||
1056 | { | ||
1057 | u16 speed = get_usb_speed(r8a66597); | ||
1058 | |||
1059 | switch (speed) { | ||
1060 | case HSMODE: | ||
1061 | r8a66597->gadget.speed = USB_SPEED_HIGH; | ||
1062 | break; | ||
1063 | case FSMODE: | ||
1064 | r8a66597->gadget.speed = USB_SPEED_FULL; | ||
1065 | break; | ||
1066 | default: | ||
1067 | r8a66597->gadget.speed = USB_SPEED_UNKNOWN; | ||
1068 | printk(KERN_ERR "USB speed unknown\n"); | ||
1069 | } | ||
1070 | } | ||
1071 | |||
1072 | static void irq_device_state(struct r8a66597 *r8a66597) | ||
1073 | { | ||
1074 | u16 dvsq; | ||
1075 | |||
1076 | dvsq = r8a66597_read(r8a66597, INTSTS0) & DVSQ; | ||
1077 | r8a66597_write(r8a66597, ~DVST, INTSTS0); | ||
1078 | |||
1079 | if (dvsq == DS_DFLT) { | ||
1080 | /* bus reset */ | ||
1081 | r8a66597->driver->disconnect(&r8a66597->gadget); | ||
1082 | r8a66597_update_usb_speed(r8a66597); | ||
1083 | } | ||
1084 | if (r8a66597->old_dvsq == DS_CNFG && dvsq != DS_CNFG) | ||
1085 | r8a66597_update_usb_speed(r8a66597); | ||
1086 | if ((dvsq == DS_CNFG || dvsq == DS_ADDS) | ||
1087 | && r8a66597->gadget.speed == USB_SPEED_UNKNOWN) | ||
1088 | r8a66597_update_usb_speed(r8a66597); | ||
1089 | |||
1090 | r8a66597->old_dvsq = dvsq; | ||
1091 | } | ||
1092 | |||
1093 | static void irq_control_stage(struct r8a66597 *r8a66597) | ||
1094 | __releases(r8a66597->lock) | ||
1095 | __acquires(r8a66597->lock) | ||
1096 | { | ||
1097 | struct usb_ctrlrequest ctrl; | ||
1098 | u16 ctsq; | ||
1099 | |||
1100 | ctsq = r8a66597_read(r8a66597, INTSTS0) & CTSQ; | ||
1101 | r8a66597_write(r8a66597, ~CTRT, INTSTS0); | ||
1102 | |||
1103 | switch (ctsq) { | ||
1104 | case CS_IDST: { | ||
1105 | struct r8a66597_ep *ep; | ||
1106 | struct r8a66597_request *req; | ||
1107 | ep = &r8a66597->ep[0]; | ||
1108 | req = get_request_from_ep(ep); | ||
1109 | transfer_complete(ep, req, 0); | ||
1110 | } | ||
1111 | break; | ||
1112 | |||
1113 | case CS_RDDS: | ||
1114 | case CS_WRDS: | ||
1115 | case CS_WRND: | ||
1116 | if (setup_packet(r8a66597, &ctrl)) { | ||
1117 | spin_unlock(&r8a66597->lock); | ||
1118 | if (r8a66597->driver->setup(&r8a66597->gadget, &ctrl) | ||
1119 | < 0) | ||
1120 | pipe_stall(r8a66597, 0); | ||
1121 | spin_lock(&r8a66597->lock); | ||
1122 | } | ||
1123 | break; | ||
1124 | case CS_RDSS: | ||
1125 | case CS_WRSS: | ||
1126 | control_end(r8a66597, 0); | ||
1127 | break; | ||
1128 | default: | ||
1129 | printk(KERN_ERR "ctrl_stage: unexpect ctsq(%x)\n", ctsq); | ||
1130 | break; | ||
1131 | } | ||
1132 | } | ||
1133 | |||
1134 | static irqreturn_t r8a66597_irq(int irq, void *_r8a66597) | ||
1135 | { | ||
1136 | struct r8a66597 *r8a66597 = _r8a66597; | ||
1137 | u16 intsts0; | ||
1138 | u16 intenb0; | ||
1139 | u16 brdysts, nrdysts, bempsts; | ||
1140 | u16 brdyenb, nrdyenb, bempenb; | ||
1141 | u16 savepipe; | ||
1142 | u16 mask0; | ||
1143 | |||
1144 | spin_lock(&r8a66597->lock); | ||
1145 | |||
1146 | intsts0 = r8a66597_read(r8a66597, INTSTS0); | ||
1147 | intenb0 = r8a66597_read(r8a66597, INTENB0); | ||
1148 | |||
1149 | savepipe = r8a66597_read(r8a66597, CFIFOSEL); | ||
1150 | |||
1151 | mask0 = intsts0 & intenb0; | ||
1152 | if (mask0) { | ||
1153 | brdysts = r8a66597_read(r8a66597, BRDYSTS); | ||
1154 | nrdysts = r8a66597_read(r8a66597, NRDYSTS); | ||
1155 | bempsts = r8a66597_read(r8a66597, BEMPSTS); | ||
1156 | brdyenb = r8a66597_read(r8a66597, BRDYENB); | ||
1157 | nrdyenb = r8a66597_read(r8a66597, NRDYENB); | ||
1158 | bempenb = r8a66597_read(r8a66597, BEMPENB); | ||
1159 | |||
1160 | if (mask0 & VBINT) { | ||
1161 | r8a66597_write(r8a66597, 0xffff & ~VBINT, | ||
1162 | INTSTS0); | ||
1163 | r8a66597_start_xclock(r8a66597); | ||
1164 | |||
1165 | /* start vbus sampling */ | ||
1166 | r8a66597->old_vbus = r8a66597_read(r8a66597, INTSTS0) | ||
1167 | & VBSTS; | ||
1168 | r8a66597->scount = R8A66597_MAX_SAMPLING; | ||
1169 | |||
1170 | mod_timer(&r8a66597->timer, | ||
1171 | jiffies + msecs_to_jiffies(50)); | ||
1172 | } | ||
1173 | if (intsts0 & DVSQ) | ||
1174 | irq_device_state(r8a66597); | ||
1175 | |||
1176 | if ((intsts0 & BRDY) && (intenb0 & BRDYE) | ||
1177 | && (brdysts & brdyenb)) | ||
1178 | irq_pipe_ready(r8a66597, brdysts, brdyenb); | ||
1179 | if ((intsts0 & BEMP) && (intenb0 & BEMPE) | ||
1180 | && (bempsts & bempenb)) | ||
1181 | irq_pipe_empty(r8a66597, bempsts, bempenb); | ||
1182 | |||
1183 | if (intsts0 & CTRT) | ||
1184 | irq_control_stage(r8a66597); | ||
1185 | } | ||
1186 | |||
1187 | r8a66597_write(r8a66597, savepipe, CFIFOSEL); | ||
1188 | |||
1189 | spin_unlock(&r8a66597->lock); | ||
1190 | return IRQ_HANDLED; | ||
1191 | } | ||
1192 | |||
1193 | static void r8a66597_timer(unsigned long _r8a66597) | ||
1194 | { | ||
1195 | struct r8a66597 *r8a66597 = (struct r8a66597 *)_r8a66597; | ||
1196 | unsigned long flags; | ||
1197 | u16 tmp; | ||
1198 | |||
1199 | spin_lock_irqsave(&r8a66597->lock, flags); | ||
1200 | tmp = r8a66597_read(r8a66597, SYSCFG0); | ||
1201 | if (r8a66597->scount > 0) { | ||
1202 | tmp = r8a66597_read(r8a66597, INTSTS0) & VBSTS; | ||
1203 | if (tmp == r8a66597->old_vbus) { | ||
1204 | r8a66597->scount--; | ||
1205 | if (r8a66597->scount == 0) { | ||
1206 | if (tmp == VBSTS) | ||
1207 | r8a66597_usb_connect(r8a66597); | ||
1208 | else | ||
1209 | r8a66597_usb_disconnect(r8a66597); | ||
1210 | } else { | ||
1211 | mod_timer(&r8a66597->timer, | ||
1212 | jiffies + msecs_to_jiffies(50)); | ||
1213 | } | ||
1214 | } else { | ||
1215 | r8a66597->scount = R8A66597_MAX_SAMPLING; | ||
1216 | r8a66597->old_vbus = tmp; | ||
1217 | mod_timer(&r8a66597->timer, | ||
1218 | jiffies + msecs_to_jiffies(50)); | ||
1219 | } | ||
1220 | } | ||
1221 | spin_unlock_irqrestore(&r8a66597->lock, flags); | ||
1222 | } | ||
1223 | |||
1224 | /*-------------------------------------------------------------------------*/ | ||
1225 | static int r8a66597_enable(struct usb_ep *_ep, | ||
1226 | const struct usb_endpoint_descriptor *desc) | ||
1227 | { | ||
1228 | struct r8a66597_ep *ep; | ||
1229 | |||
1230 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1231 | return alloc_pipe_config(ep, desc); | ||
1232 | } | ||
1233 | |||
1234 | static int r8a66597_disable(struct usb_ep *_ep) | ||
1235 | { | ||
1236 | struct r8a66597_ep *ep; | ||
1237 | struct r8a66597_request *req; | ||
1238 | unsigned long flags; | ||
1239 | |||
1240 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1241 | BUG_ON(!ep); | ||
1242 | |||
1243 | while (!list_empty(&ep->queue)) { | ||
1244 | req = get_request_from_ep(ep); | ||
1245 | spin_lock_irqsave(&ep->r8a66597->lock, flags); | ||
1246 | transfer_complete(ep, req, -ECONNRESET); | ||
1247 | spin_unlock_irqrestore(&ep->r8a66597->lock, flags); | ||
1248 | } | ||
1249 | |||
1250 | pipe_irq_disable(ep->r8a66597, ep->pipenum); | ||
1251 | return free_pipe_config(ep); | ||
1252 | } | ||
1253 | |||
1254 | static struct usb_request *r8a66597_alloc_request(struct usb_ep *_ep, | ||
1255 | gfp_t gfp_flags) | ||
1256 | { | ||
1257 | struct r8a66597_request *req; | ||
1258 | |||
1259 | req = kzalloc(sizeof(struct r8a66597_request), gfp_flags); | ||
1260 | if (!req) | ||
1261 | return NULL; | ||
1262 | |||
1263 | INIT_LIST_HEAD(&req->queue); | ||
1264 | |||
1265 | return &req->req; | ||
1266 | } | ||
1267 | |||
1268 | static void r8a66597_free_request(struct usb_ep *_ep, struct usb_request *_req) | ||
1269 | { | ||
1270 | struct r8a66597_request *req; | ||
1271 | |||
1272 | req = container_of(_req, struct r8a66597_request, req); | ||
1273 | kfree(req); | ||
1274 | } | ||
1275 | |||
1276 | static int r8a66597_queue(struct usb_ep *_ep, struct usb_request *_req, | ||
1277 | gfp_t gfp_flags) | ||
1278 | { | ||
1279 | struct r8a66597_ep *ep; | ||
1280 | struct r8a66597_request *req; | ||
1281 | unsigned long flags; | ||
1282 | int request = 0; | ||
1283 | |||
1284 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1285 | req = container_of(_req, struct r8a66597_request, req); | ||
1286 | |||
1287 | if (ep->r8a66597->gadget.speed == USB_SPEED_UNKNOWN) | ||
1288 | return -ESHUTDOWN; | ||
1289 | |||
1290 | spin_lock_irqsave(&ep->r8a66597->lock, flags); | ||
1291 | |||
1292 | if (list_empty(&ep->queue)) | ||
1293 | request = 1; | ||
1294 | |||
1295 | list_add_tail(&req->queue, &ep->queue); | ||
1296 | req->req.actual = 0; | ||
1297 | req->req.status = -EINPROGRESS; | ||
1298 | |||
1299 | if (ep->desc == NULL) /* control */ | ||
1300 | start_ep0(ep, req); | ||
1301 | else { | ||
1302 | if (request && !ep->busy) | ||
1303 | start_packet(ep, req); | ||
1304 | } | ||
1305 | |||
1306 | spin_unlock_irqrestore(&ep->r8a66597->lock, flags); | ||
1307 | |||
1308 | return 0; | ||
1309 | } | ||
1310 | |||
1311 | static int r8a66597_dequeue(struct usb_ep *_ep, struct usb_request *_req) | ||
1312 | { | ||
1313 | struct r8a66597_ep *ep; | ||
1314 | struct r8a66597_request *req; | ||
1315 | unsigned long flags; | ||
1316 | |||
1317 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1318 | req = container_of(_req, struct r8a66597_request, req); | ||
1319 | |||
1320 | spin_lock_irqsave(&ep->r8a66597->lock, flags); | ||
1321 | if (!list_empty(&ep->queue)) | ||
1322 | transfer_complete(ep, req, -ECONNRESET); | ||
1323 | spin_unlock_irqrestore(&ep->r8a66597->lock, flags); | ||
1324 | |||
1325 | return 0; | ||
1326 | } | ||
1327 | |||
1328 | static int r8a66597_set_halt(struct usb_ep *_ep, int value) | ||
1329 | { | ||
1330 | struct r8a66597_ep *ep; | ||
1331 | struct r8a66597_request *req; | ||
1332 | unsigned long flags; | ||
1333 | int ret = 0; | ||
1334 | |||
1335 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1336 | req = get_request_from_ep(ep); | ||
1337 | |||
1338 | spin_lock_irqsave(&ep->r8a66597->lock, flags); | ||
1339 | if (!list_empty(&ep->queue)) { | ||
1340 | ret = -EAGAIN; | ||
1341 | goto out; | ||
1342 | } | ||
1343 | if (value) { | ||
1344 | ep->busy = 1; | ||
1345 | pipe_stall(ep->r8a66597, ep->pipenum); | ||
1346 | } else { | ||
1347 | ep->busy = 0; | ||
1348 | ep->wedge = 0; | ||
1349 | pipe_stop(ep->r8a66597, ep->pipenum); | ||
1350 | } | ||
1351 | |||
1352 | out: | ||
1353 | spin_unlock_irqrestore(&ep->r8a66597->lock, flags); | ||
1354 | return ret; | ||
1355 | } | ||
1356 | |||
1357 | static int r8a66597_set_wedge(struct usb_ep *_ep) | ||
1358 | { | ||
1359 | struct r8a66597_ep *ep; | ||
1360 | unsigned long flags; | ||
1361 | |||
1362 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1363 | |||
1364 | if (!ep || !ep->desc) | ||
1365 | return -EINVAL; | ||
1366 | |||
1367 | spin_lock_irqsave(&ep->r8a66597->lock, flags); | ||
1368 | ep->wedge = 1; | ||
1369 | spin_unlock_irqrestore(&ep->r8a66597->lock, flags); | ||
1370 | |||
1371 | return usb_ep_set_halt(_ep); | ||
1372 | } | ||
1373 | |||
1374 | static void r8a66597_fifo_flush(struct usb_ep *_ep) | ||
1375 | { | ||
1376 | struct r8a66597_ep *ep; | ||
1377 | unsigned long flags; | ||
1378 | |||
1379 | ep = container_of(_ep, struct r8a66597_ep, ep); | ||
1380 | spin_lock_irqsave(&ep->r8a66597->lock, flags); | ||
1381 | if (list_empty(&ep->queue) && !ep->busy) { | ||
1382 | pipe_stop(ep->r8a66597, ep->pipenum); | ||
1383 | r8a66597_bclr(ep->r8a66597, BCLR, ep->fifoctr); | ||
1384 | } | ||
1385 | spin_unlock_irqrestore(&ep->r8a66597->lock, flags); | ||
1386 | } | ||
1387 | |||
1388 | static struct usb_ep_ops r8a66597_ep_ops = { | ||
1389 | .enable = r8a66597_enable, | ||
1390 | .disable = r8a66597_disable, | ||
1391 | |||
1392 | .alloc_request = r8a66597_alloc_request, | ||
1393 | .free_request = r8a66597_free_request, | ||
1394 | |||
1395 | .queue = r8a66597_queue, | ||
1396 | .dequeue = r8a66597_dequeue, | ||
1397 | |||
1398 | .set_halt = r8a66597_set_halt, | ||
1399 | .set_wedge = r8a66597_set_wedge, | ||
1400 | .fifo_flush = r8a66597_fifo_flush, | ||
1401 | }; | ||
1402 | |||
1403 | /*-------------------------------------------------------------------------*/ | ||
1404 | static struct r8a66597 *the_controller; | ||
1405 | |||
1406 | int usb_gadget_register_driver(struct usb_gadget_driver *driver) | ||
1407 | { | ||
1408 | struct r8a66597 *r8a66597 = the_controller; | ||
1409 | int retval; | ||
1410 | |||
1411 | if (!driver | ||
1412 | || driver->speed != USB_SPEED_HIGH | ||
1413 | || !driver->bind | ||
1414 | || !driver->setup) | ||
1415 | return -EINVAL; | ||
1416 | if (!r8a66597) | ||
1417 | return -ENODEV; | ||
1418 | if (r8a66597->driver) | ||
1419 | return -EBUSY; | ||
1420 | |||
1421 | /* hook up the driver */ | ||
1422 | driver->driver.bus = NULL; | ||
1423 | r8a66597->driver = driver; | ||
1424 | r8a66597->gadget.dev.driver = &driver->driver; | ||
1425 | |||
1426 | retval = device_add(&r8a66597->gadget.dev); | ||
1427 | if (retval) { | ||
1428 | printk(KERN_ERR "device_add error (%d)\n", retval); | ||
1429 | goto error; | ||
1430 | } | ||
1431 | |||
1432 | retval = driver->bind(&r8a66597->gadget); | ||
1433 | if (retval) { | ||
1434 | printk(KERN_ERR "bind to driver error (%d)\n", retval); | ||
1435 | device_del(&r8a66597->gadget.dev); | ||
1436 | goto error; | ||
1437 | } | ||
1438 | |||
1439 | r8a66597_bset(r8a66597, VBSE, INTENB0); | ||
1440 | if (r8a66597_read(r8a66597, INTSTS0) & VBSTS) { | ||
1441 | r8a66597_start_xclock(r8a66597); | ||
1442 | /* start vbus sampling */ | ||
1443 | r8a66597->old_vbus = r8a66597_read(r8a66597, | ||
1444 | INTSTS0) & VBSTS; | ||
1445 | r8a66597->scount = R8A66597_MAX_SAMPLING; | ||
1446 | mod_timer(&r8a66597->timer, jiffies + msecs_to_jiffies(50)); | ||
1447 | } | ||
1448 | |||
1449 | return 0; | ||
1450 | |||
1451 | error: | ||
1452 | r8a66597->driver = NULL; | ||
1453 | r8a66597->gadget.dev.driver = NULL; | ||
1454 | |||
1455 | return retval; | ||
1456 | } | ||
1457 | EXPORT_SYMBOL(usb_gadget_register_driver); | ||
1458 | |||
1459 | int usb_gadget_unregister_driver(struct usb_gadget_driver *driver) | ||
1460 | { | ||
1461 | struct r8a66597 *r8a66597 = the_controller; | ||
1462 | unsigned long flags; | ||
1463 | |||
1464 | if (driver != r8a66597->driver || !driver->unbind) | ||
1465 | return -EINVAL; | ||
1466 | |||
1467 | spin_lock_irqsave(&r8a66597->lock, flags); | ||
1468 | if (r8a66597->gadget.speed != USB_SPEED_UNKNOWN) | ||
1469 | r8a66597_usb_disconnect(r8a66597); | ||
1470 | spin_unlock_irqrestore(&r8a66597->lock, flags); | ||
1471 | |||
1472 | r8a66597_bclr(r8a66597, VBSE, INTENB0); | ||
1473 | |||
1474 | driver->unbind(&r8a66597->gadget); | ||
1475 | |||
1476 | init_controller(r8a66597); | ||
1477 | disable_controller(r8a66597); | ||
1478 | |||
1479 | device_del(&r8a66597->gadget.dev); | ||
1480 | r8a66597->driver = NULL; | ||
1481 | return 0; | ||
1482 | } | ||
1483 | EXPORT_SYMBOL(usb_gadget_unregister_driver); | ||
1484 | |||
1485 | /*-------------------------------------------------------------------------*/ | ||
1486 | static int r8a66597_get_frame(struct usb_gadget *_gadget) | ||
1487 | { | ||
1488 | struct r8a66597 *r8a66597 = gadget_to_r8a66597(_gadget); | ||
1489 | return r8a66597_read(r8a66597, FRMNUM) & 0x03FF; | ||
1490 | } | ||
1491 | |||
1492 | static struct usb_gadget_ops r8a66597_gadget_ops = { | ||
1493 | .get_frame = r8a66597_get_frame, | ||
1494 | }; | ||
1495 | |||
1496 | static int __exit r8a66597_remove(struct platform_device *pdev) | ||
1497 | { | ||
1498 | struct r8a66597 *r8a66597 = dev_get_drvdata(&pdev->dev); | ||
1499 | |||
1500 | del_timer_sync(&r8a66597->timer); | ||
1501 | iounmap((void *)r8a66597->reg); | ||
1502 | free_irq(platform_get_irq(pdev, 0), r8a66597); | ||
1503 | r8a66597_free_request(&r8a66597->ep[0].ep, r8a66597->ep0_req); | ||
1504 | #ifdef CONFIG_HAVE_CLK | ||
1505 | if (r8a66597->pdata->on_chip) { | ||
1506 | clk_disable(r8a66597->clk); | ||
1507 | clk_put(r8a66597->clk); | ||
1508 | } | ||
1509 | #endif | ||
1510 | kfree(r8a66597); | ||
1511 | return 0; | ||
1512 | } | ||
1513 | |||
1514 | static void nop_completion(struct usb_ep *ep, struct usb_request *r) | ||
1515 | { | ||
1516 | } | ||
1517 | |||
1518 | static int __init r8a66597_probe(struct platform_device *pdev) | ||
1519 | { | ||
1520 | #ifdef CONFIG_HAVE_CLK | ||
1521 | char clk_name[8]; | ||
1522 | #endif | ||
1523 | struct resource *res, *ires; | ||
1524 | int irq; | ||
1525 | void __iomem *reg = NULL; | ||
1526 | struct r8a66597 *r8a66597 = NULL; | ||
1527 | int ret = 0; | ||
1528 | int i; | ||
1529 | unsigned long irq_trigger; | ||
1530 | |||
1531 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
1532 | if (!res) { | ||
1533 | ret = -ENODEV; | ||
1534 | printk(KERN_ERR "platform_get_resource error.\n"); | ||
1535 | goto clean_up; | ||
1536 | } | ||
1537 | |||
1538 | ires = platform_get_resource(pdev, IORESOURCE_IRQ, 0); | ||
1539 | irq = ires->start; | ||
1540 | irq_trigger = ires->flags & IRQF_TRIGGER_MASK; | ||
1541 | |||
1542 | if (irq < 0) { | ||
1543 | ret = -ENODEV; | ||
1544 | printk(KERN_ERR "platform_get_irq error.\n"); | ||
1545 | goto clean_up; | ||
1546 | } | ||
1547 | |||
1548 | reg = ioremap(res->start, resource_size(res)); | ||
1549 | if (reg == NULL) { | ||
1550 | ret = -ENOMEM; | ||
1551 | printk(KERN_ERR "ioremap error.\n"); | ||
1552 | goto clean_up; | ||
1553 | } | ||
1554 | |||
1555 | /* initialize ucd */ | ||
1556 | r8a66597 = kzalloc(sizeof(struct r8a66597), GFP_KERNEL); | ||
1557 | if (r8a66597 == NULL) { | ||
1558 | printk(KERN_ERR "kzalloc error\n"); | ||
1559 | goto clean_up; | ||
1560 | } | ||
1561 | |||
1562 | spin_lock_init(&r8a66597->lock); | ||
1563 | dev_set_drvdata(&pdev->dev, r8a66597); | ||
1564 | r8a66597->pdata = pdev->dev.platform_data; | ||
1565 | r8a66597->irq_sense_low = irq_trigger == IRQF_TRIGGER_LOW; | ||
1566 | |||
1567 | r8a66597->gadget.ops = &r8a66597_gadget_ops; | ||
1568 | device_initialize(&r8a66597->gadget.dev); | ||
1569 | dev_set_name(&r8a66597->gadget.dev, "gadget"); | ||
1570 | r8a66597->gadget.is_dualspeed = 1; | ||
1571 | r8a66597->gadget.dev.parent = &pdev->dev; | ||
1572 | r8a66597->gadget.dev.dma_mask = pdev->dev.dma_mask; | ||
1573 | r8a66597->gadget.dev.release = pdev->dev.release; | ||
1574 | r8a66597->gadget.name = udc_name; | ||
1575 | |||
1576 | init_timer(&r8a66597->timer); | ||
1577 | r8a66597->timer.function = r8a66597_timer; | ||
1578 | r8a66597->timer.data = (unsigned long)r8a66597; | ||
1579 | r8a66597->reg = (unsigned long)reg; | ||
1580 | |||
1581 | #ifdef CONFIG_HAVE_CLK | ||
1582 | if (r8a66597->pdata->on_chip) { | ||
1583 | snprintf(clk_name, sizeof(clk_name), "usb%d", pdev->id); | ||
1584 | r8a66597->clk = clk_get(&pdev->dev, clk_name); | ||
1585 | if (IS_ERR(r8a66597->clk)) { | ||
1586 | dev_err(&pdev->dev, "cannot get clock \"%s\"\n", | ||
1587 | clk_name); | ||
1588 | ret = PTR_ERR(r8a66597->clk); | ||
1589 | goto clean_up; | ||
1590 | } | ||
1591 | clk_enable(r8a66597->clk); | ||
1592 | } | ||
1593 | #endif | ||
1594 | |||
1595 | disable_controller(r8a66597); /* make sure controller is disabled */ | ||
1596 | |||
1597 | ret = request_irq(irq, r8a66597_irq, IRQF_DISABLED | IRQF_SHARED, | ||
1598 | udc_name, r8a66597); | ||
1599 | if (ret < 0) { | ||
1600 | printk(KERN_ERR "request_irq error (%d)\n", ret); | ||
1601 | goto clean_up2; | ||
1602 | } | ||
1603 | |||
1604 | INIT_LIST_HEAD(&r8a66597->gadget.ep_list); | ||
1605 | r8a66597->gadget.ep0 = &r8a66597->ep[0].ep; | ||
1606 | INIT_LIST_HEAD(&r8a66597->gadget.ep0->ep_list); | ||
1607 | for (i = 0; i < R8A66597_MAX_NUM_PIPE; i++) { | ||
1608 | struct r8a66597_ep *ep = &r8a66597->ep[i]; | ||
1609 | |||
1610 | if (i != 0) { | ||
1611 | INIT_LIST_HEAD(&r8a66597->ep[i].ep.ep_list); | ||
1612 | list_add_tail(&r8a66597->ep[i].ep.ep_list, | ||
1613 | &r8a66597->gadget.ep_list); | ||
1614 | } | ||
1615 | ep->r8a66597 = r8a66597; | ||
1616 | INIT_LIST_HEAD(&ep->queue); | ||
1617 | ep->ep.name = r8a66597_ep_name[i]; | ||
1618 | ep->ep.ops = &r8a66597_ep_ops; | ||
1619 | ep->ep.maxpacket = 512; | ||
1620 | } | ||
1621 | r8a66597->ep[0].ep.maxpacket = 64; | ||
1622 | r8a66597->ep[0].pipenum = 0; | ||
1623 | r8a66597->ep[0].fifoaddr = CFIFO; | ||
1624 | r8a66597->ep[0].fifosel = CFIFOSEL; | ||
1625 | r8a66597->ep[0].fifoctr = CFIFOCTR; | ||
1626 | r8a66597->ep[0].fifotrn = 0; | ||
1627 | r8a66597->ep[0].pipectr = get_pipectr_addr(0); | ||
1628 | r8a66597->pipenum2ep[0] = &r8a66597->ep[0]; | ||
1629 | r8a66597->epaddr2ep[0] = &r8a66597->ep[0]; | ||
1630 | |||
1631 | the_controller = r8a66597; | ||
1632 | |||
1633 | r8a66597->ep0_req = r8a66597_alloc_request(&r8a66597->ep[0].ep, | ||
1634 | GFP_KERNEL); | ||
1635 | if (r8a66597->ep0_req == NULL) | ||
1636 | goto clean_up3; | ||
1637 | r8a66597->ep0_req->complete = nop_completion; | ||
1638 | |||
1639 | init_controller(r8a66597); | ||
1640 | |||
1641 | dev_info(&pdev->dev, "version %s\n", DRIVER_VERSION); | ||
1642 | return 0; | ||
1643 | |||
1644 | clean_up3: | ||
1645 | free_irq(irq, r8a66597); | ||
1646 | clean_up2: | ||
1647 | #ifdef CONFIG_HAVE_CLK | ||
1648 | if (r8a66597->pdata->on_chip) { | ||
1649 | clk_disable(r8a66597->clk); | ||
1650 | clk_put(r8a66597->clk); | ||
1651 | } | ||
1652 | #endif | ||
1653 | clean_up: | ||
1654 | if (r8a66597) { | ||
1655 | if (r8a66597->ep0_req) | ||
1656 | r8a66597_free_request(&r8a66597->ep[0].ep, | ||
1657 | r8a66597->ep0_req); | ||
1658 | kfree(r8a66597); | ||
1659 | } | ||
1660 | if (reg) | ||
1661 | iounmap(reg); | ||
1662 | |||
1663 | return ret; | ||
1664 | } | ||
1665 | |||
1666 | /*-------------------------------------------------------------------------*/ | ||
1667 | static struct platform_driver r8a66597_driver = { | ||
1668 | .remove = __exit_p(r8a66597_remove), | ||
1669 | .driver = { | ||
1670 | .name = (char *) udc_name, | ||
1671 | }, | ||
1672 | }; | ||
1673 | |||
1674 | static int __init r8a66597_udc_init(void) | ||
1675 | { | ||
1676 | return platform_driver_probe(&r8a66597_driver, r8a66597_probe); | ||
1677 | } | ||
1678 | module_init(r8a66597_udc_init); | ||
1679 | |||
1680 | static void __exit r8a66597_udc_cleanup(void) | ||
1681 | { | ||
1682 | platform_driver_unregister(&r8a66597_driver); | ||
1683 | } | ||
1684 | module_exit(r8a66597_udc_cleanup); | ||
1685 | |||
1686 | MODULE_DESCRIPTION("R8A66597 USB gadget driver"); | ||
1687 | MODULE_LICENSE("GPL"); | ||
1688 | MODULE_AUTHOR("Yoshihiro Shimoda"); | ||
1689 | |||
diff --git a/drivers/usb/gadget/r8a66597-udc.h b/drivers/usb/gadget/r8a66597-udc.h new file mode 100644 index 000000000000..03087e7b9190 --- /dev/null +++ b/drivers/usb/gadget/r8a66597-udc.h | |||
@@ -0,0 +1,256 @@ | |||
1 | /* | ||
2 | * R8A66597 UDC | ||
3 | * | ||
4 | * Copyright (C) 2007-2009 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 | #ifndef __R8A66597_H__ | ||
24 | #define __R8A66597_H__ | ||
25 | |||
26 | #ifdef CONFIG_HAVE_CLK | ||
27 | #include <linux/clk.h> | ||
28 | #endif | ||
29 | |||
30 | #include <linux/usb/r8a66597.h> | ||
31 | |||
32 | #define R8A66597_MAX_SAMPLING 10 | ||
33 | |||
34 | #define R8A66597_MAX_NUM_PIPE 8 | ||
35 | #define R8A66597_MAX_NUM_BULK 3 | ||
36 | #define R8A66597_MAX_NUM_ISOC 2 | ||
37 | #define R8A66597_MAX_NUM_INT 2 | ||
38 | |||
39 | #define R8A66597_BASE_PIPENUM_BULK 3 | ||
40 | #define R8A66597_BASE_PIPENUM_ISOC 1 | ||
41 | #define R8A66597_BASE_PIPENUM_INT 6 | ||
42 | |||
43 | #define R8A66597_BASE_BUFNUM 6 | ||
44 | #define R8A66597_MAX_BUFNUM 0x4F | ||
45 | |||
46 | #define is_bulk_pipe(pipenum) \ | ||
47 | ((pipenum >= R8A66597_BASE_PIPENUM_BULK) && \ | ||
48 | (pipenum < (R8A66597_BASE_PIPENUM_BULK + R8A66597_MAX_NUM_BULK))) | ||
49 | #define is_interrupt_pipe(pipenum) \ | ||
50 | ((pipenum >= R8A66597_BASE_PIPENUM_INT) && \ | ||
51 | (pipenum < (R8A66597_BASE_PIPENUM_INT + R8A66597_MAX_NUM_INT))) | ||
52 | #define is_isoc_pipe(pipenum) \ | ||
53 | ((pipenum >= R8A66597_BASE_PIPENUM_ISOC) && \ | ||
54 | (pipenum < (R8A66597_BASE_PIPENUM_ISOC + R8A66597_MAX_NUM_ISOC))) | ||
55 | |||
56 | struct r8a66597_pipe_info { | ||
57 | u16 pipe; | ||
58 | u16 epnum; | ||
59 | u16 maxpacket; | ||
60 | u16 type; | ||
61 | u16 interval; | ||
62 | u16 dir_in; | ||
63 | }; | ||
64 | |||
65 | struct r8a66597_request { | ||
66 | struct usb_request req; | ||
67 | struct list_head queue; | ||
68 | }; | ||
69 | |||
70 | struct r8a66597_ep { | ||
71 | struct usb_ep ep; | ||
72 | struct r8a66597 *r8a66597; | ||
73 | |||
74 | struct list_head queue; | ||
75 | unsigned busy:1; | ||
76 | unsigned wedge:1; | ||
77 | unsigned internal_ccpl:1; /* use only control */ | ||
78 | |||
79 | /* this member can able to after r8a66597_enable */ | ||
80 | unsigned use_dma:1; | ||
81 | u16 pipenum; | ||
82 | u16 type; | ||
83 | const struct usb_endpoint_descriptor *desc; | ||
84 | /* register address */ | ||
85 | unsigned char fifoaddr; | ||
86 | unsigned char fifosel; | ||
87 | unsigned char fifoctr; | ||
88 | unsigned char fifotrn; | ||
89 | unsigned char pipectr; | ||
90 | }; | ||
91 | |||
92 | struct r8a66597 { | ||
93 | spinlock_t lock; | ||
94 | unsigned long reg; | ||
95 | |||
96 | #ifdef CONFIG_HAVE_CLK | ||
97 | struct clk *clk; | ||
98 | #endif | ||
99 | struct r8a66597_platdata *pdata; | ||
100 | |||
101 | struct usb_gadget gadget; | ||
102 | struct usb_gadget_driver *driver; | ||
103 | |||
104 | struct r8a66597_ep ep[R8A66597_MAX_NUM_PIPE]; | ||
105 | struct r8a66597_ep *pipenum2ep[R8A66597_MAX_NUM_PIPE]; | ||
106 | struct r8a66597_ep *epaddr2ep[16]; | ||
107 | |||
108 | struct timer_list timer; | ||
109 | struct usb_request *ep0_req; /* for internal request */ | ||
110 | u16 ep0_data; /* for internal request */ | ||
111 | u16 old_vbus; | ||
112 | u16 scount; | ||
113 | u16 old_dvsq; | ||
114 | |||
115 | /* pipe config */ | ||
116 | unsigned char bulk; | ||
117 | unsigned char interrupt; | ||
118 | unsigned char isochronous; | ||
119 | unsigned char num_dma; | ||
120 | |||
121 | unsigned irq_sense_low:1; | ||
122 | }; | ||
123 | |||
124 | #define gadget_to_r8a66597(_gadget) \ | ||
125 | container_of(_gadget, struct r8a66597, gadget) | ||
126 | #define r8a66597_to_gadget(r8a66597) (&r8a66597->gadget) | ||
127 | |||
128 | static inline u16 r8a66597_read(struct r8a66597 *r8a66597, unsigned long offset) | ||
129 | { | ||
130 | return inw(r8a66597->reg + offset); | ||
131 | } | ||
132 | |||
133 | static inline void r8a66597_read_fifo(struct r8a66597 *r8a66597, | ||
134 | unsigned long offset, u16 *buf, | ||
135 | int len) | ||
136 | { | ||
137 | if (r8a66597->pdata->on_chip) { | ||
138 | unsigned long fifoaddr = r8a66597->reg + offset; | ||
139 | unsigned long count; | ||
140 | union { | ||
141 | unsigned long dword; | ||
142 | unsigned char byte[4]; | ||
143 | } data; | ||
144 | unsigned char *pb; | ||
145 | int i; | ||
146 | |||
147 | count = len / 4; | ||
148 | insl(fifoaddr, buf, count); | ||
149 | |||
150 | if (len & 0x00000003) { | ||
151 | data.dword = inl(fifoaddr); | ||
152 | pb = (unsigned char *)buf + count * 4; | ||
153 | for (i = 0; i < (len & 0x00000003); i++) | ||
154 | pb[i] = data.byte[i]; | ||
155 | } | ||
156 | } else { | ||
157 | len = (len + 1) / 2; | ||
158 | insw(r8a66597->reg + offset, buf, len); | ||
159 | } | ||
160 | } | ||
161 | |||
162 | static inline void r8a66597_write(struct r8a66597 *r8a66597, u16 val, | ||
163 | unsigned long offset) | ||
164 | { | ||
165 | outw(val, r8a66597->reg + offset); | ||
166 | } | ||
167 | |||
168 | static inline void r8a66597_write_fifo(struct r8a66597 *r8a66597, | ||
169 | unsigned long offset, u16 *buf, | ||
170 | int len) | ||
171 | { | ||
172 | unsigned long fifoaddr = r8a66597->reg + offset; | ||
173 | |||
174 | if (r8a66597->pdata->on_chip) { | ||
175 | unsigned long count; | ||
176 | unsigned char *pb; | ||
177 | int i; | ||
178 | |||
179 | count = len / 4; | ||
180 | outsl(fifoaddr, buf, count); | ||
181 | |||
182 | if (len & 0x00000003) { | ||
183 | pb = (unsigned char *)buf + count * 4; | ||
184 | for (i = 0; i < (len & 0x00000003); i++) { | ||
185 | if (r8a66597_read(r8a66597, CFIFOSEL) & BIGEND) | ||
186 | outb(pb[i], fifoaddr + i); | ||
187 | else | ||
188 | outb(pb[i], fifoaddr + 3 - i); | ||
189 | } | ||
190 | } | ||
191 | } else { | ||
192 | int odd = len & 0x0001; | ||
193 | |||
194 | len = len / 2; | ||
195 | outsw(fifoaddr, buf, len); | ||
196 | if (unlikely(odd)) { | ||
197 | buf = &buf[len]; | ||
198 | outb((unsigned char)*buf, fifoaddr); | ||
199 | } | ||
200 | } | ||
201 | } | ||
202 | |||
203 | static inline void r8a66597_mdfy(struct r8a66597 *r8a66597, | ||
204 | u16 val, u16 pat, unsigned long offset) | ||
205 | { | ||
206 | u16 tmp; | ||
207 | tmp = r8a66597_read(r8a66597, offset); | ||
208 | tmp = tmp & (~pat); | ||
209 | tmp = tmp | val; | ||
210 | r8a66597_write(r8a66597, tmp, offset); | ||
211 | } | ||
212 | |||
213 | static inline u16 get_xtal_from_pdata(struct r8a66597_platdata *pdata) | ||
214 | { | ||
215 | u16 clock = 0; | ||
216 | |||
217 | switch (pdata->xtal) { | ||
218 | case R8A66597_PLATDATA_XTAL_12MHZ: | ||
219 | clock = XTAL12; | ||
220 | break; | ||
221 | case R8A66597_PLATDATA_XTAL_24MHZ: | ||
222 | clock = XTAL24; | ||
223 | break; | ||
224 | case R8A66597_PLATDATA_XTAL_48MHZ: | ||
225 | clock = XTAL48; | ||
226 | break; | ||
227 | default: | ||
228 | printk(KERN_ERR "r8a66597: platdata clock is wrong.\n"); | ||
229 | break; | ||
230 | } | ||
231 | |||
232 | return clock; | ||
233 | } | ||
234 | |||
235 | #define r8a66597_bclr(r8a66597, val, offset) \ | ||
236 | r8a66597_mdfy(r8a66597, 0, val, offset) | ||
237 | #define r8a66597_bset(r8a66597, val, offset) \ | ||
238 | r8a66597_mdfy(r8a66597, val, 0, offset) | ||
239 | |||
240 | #define get_pipectr_addr(pipenum) (PIPE1CTR + (pipenum - 1) * 2) | ||
241 | |||
242 | #define enable_irq_ready(r8a66597, pipenum) \ | ||
243 | enable_pipe_irq(r8a66597, pipenum, BRDYENB) | ||
244 | #define disable_irq_ready(r8a66597, pipenum) \ | ||
245 | disable_pipe_irq(r8a66597, pipenum, BRDYENB) | ||
246 | #define enable_irq_empty(r8a66597, pipenum) \ | ||
247 | enable_pipe_irq(r8a66597, pipenum, BEMPENB) | ||
248 | #define disable_irq_empty(r8a66597, pipenum) \ | ||
249 | disable_pipe_irq(r8a66597, pipenum, BEMPENB) | ||
250 | #define enable_irq_nrdy(r8a66597, pipenum) \ | ||
251 | enable_pipe_irq(r8a66597, pipenum, NRDYENB) | ||
252 | #define disable_irq_nrdy(r8a66597, pipenum) \ | ||
253 | disable_pipe_irq(r8a66597, pipenum, NRDYENB) | ||
254 | |||
255 | #endif /* __R8A66597_H__ */ | ||
256 | |||
diff --git a/drivers/usb/host/Kconfig b/drivers/usb/host/Kconfig index 1a920c70b5a1..f21ca7d27a43 100644 --- a/drivers/usb/host/Kconfig +++ b/drivers/usb/host/Kconfig | |||
@@ -336,13 +336,6 @@ config USB_R8A66597_HCD | |||
336 | To compile this driver as a module, choose M here: the | 336 | To compile this driver as a module, choose M here: the |
337 | module will be called r8a66597-hcd. | 337 | module will be called r8a66597-hcd. |
338 | 338 | ||
339 | config SUPERH_ON_CHIP_R8A66597 | ||
340 | boolean "Enable SuperH on-chip R8A66597 USB" | ||
341 | depends on USB_R8A66597_HCD && (CPU_SUBTYPE_SH7366 || CPU_SUBTYPE_SH7723 || CPU_SUBTYPE_SH7724) | ||
342 | help | ||
343 | This driver enables support for the on-chip R8A66597 in the | ||
344 | SH7366, SH7723 and SH7724 processors. | ||
345 | |||
346 | config USB_WHCI_HCD | 339 | config USB_WHCI_HCD |
347 | tristate "Wireless USB Host Controller Interface (WHCI) driver (EXPERIMENTAL)" | 340 | tristate "Wireless USB Host Controller Interface (WHCI) driver (EXPERIMENTAL)" |
348 | depends on EXPERIMENTAL | 341 | depends on EXPERIMENTAL |
diff --git a/drivers/usb/host/r8a66597-hcd.c b/drivers/usb/host/r8a66597-hcd.c index e18f74946e68..749b53742828 100644 --- a/drivers/usb/host/r8a66597-hcd.c +++ b/drivers/usb/host/r8a66597-hcd.c | |||
@@ -91,43 +91,43 @@ static int r8a66597_clock_enable(struct r8a66597 *r8a66597) | |||
91 | u16 tmp; | 91 | u16 tmp; |
92 | int i = 0; | 92 | int i = 0; |
93 | 93 | ||
94 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | 94 | if (r8a66597->pdata->on_chip) { |
95 | #if defined(CONFIG_HAVE_CLK) | 95 | #ifdef CONFIG_HAVE_CLK |
96 | clk_enable(r8a66597->clk); | 96 | clk_enable(r8a66597->clk); |
97 | #endif | 97 | #endif |
98 | do { | 98 | do { |
99 | r8a66597_write(r8a66597, SCKE, SYSCFG0); | 99 | r8a66597_write(r8a66597, SCKE, SYSCFG0); |
100 | tmp = r8a66597_read(r8a66597, SYSCFG0); | 100 | tmp = r8a66597_read(r8a66597, SYSCFG0); |
101 | if (i++ > 1000) { | 101 | if (i++ > 1000) { |
102 | printk(KERN_ERR "r8a66597: register access fail.\n"); | 102 | printk(KERN_ERR "r8a66597: reg access fail.\n"); |
103 | return -ENXIO; | 103 | return -ENXIO; |
104 | } | 104 | } |
105 | } while ((tmp & SCKE) != SCKE); | 105 | } while ((tmp & SCKE) != SCKE); |
106 | r8a66597_write(r8a66597, 0x04, 0x02); | 106 | r8a66597_write(r8a66597, 0x04, 0x02); |
107 | #else | 107 | } else { |
108 | do { | 108 | do { |
109 | r8a66597_write(r8a66597, USBE, SYSCFG0); | 109 | r8a66597_write(r8a66597, USBE, SYSCFG0); |
110 | tmp = r8a66597_read(r8a66597, SYSCFG0); | 110 | tmp = r8a66597_read(r8a66597, SYSCFG0); |
111 | if (i++ > 1000) { | 111 | if (i++ > 1000) { |
112 | printk(KERN_ERR "r8a66597: register access fail.\n"); | 112 | printk(KERN_ERR "r8a66597: reg access fail.\n"); |
113 | return -ENXIO; | 113 | return -ENXIO; |
114 | } | 114 | } |
115 | } while ((tmp & USBE) != USBE); | 115 | } while ((tmp & USBE) != USBE); |
116 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); | 116 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); |
117 | r8a66597_mdfy(r8a66597, get_xtal_from_pdata(r8a66597->pdata), XTAL, | 117 | r8a66597_mdfy(r8a66597, get_xtal_from_pdata(r8a66597->pdata), |
118 | SYSCFG0); | 118 | XTAL, SYSCFG0); |
119 | 119 | ||
120 | i = 0; | 120 | i = 0; |
121 | r8a66597_bset(r8a66597, XCKE, SYSCFG0); | 121 | r8a66597_bset(r8a66597, XCKE, SYSCFG0); |
122 | do { | 122 | do { |
123 | msleep(1); | 123 | msleep(1); |
124 | tmp = r8a66597_read(r8a66597, SYSCFG0); | 124 | tmp = r8a66597_read(r8a66597, SYSCFG0); |
125 | if (i++ > 500) { | 125 | if (i++ > 500) { |
126 | printk(KERN_ERR "r8a66597: register access fail.\n"); | 126 | printk(KERN_ERR "r8a66597: reg access fail.\n"); |
127 | return -ENXIO; | 127 | return -ENXIO; |
128 | } | 128 | } |
129 | } while ((tmp & SCKE) != SCKE); | 129 | } while ((tmp & SCKE) != SCKE); |
130 | #endif /* #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) */ | 130 | } |
131 | 131 | ||
132 | return 0; | 132 | return 0; |
133 | } | 133 | } |
@@ -136,15 +136,16 @@ static void r8a66597_clock_disable(struct r8a66597 *r8a66597) | |||
136 | { | 136 | { |
137 | r8a66597_bclr(r8a66597, SCKE, SYSCFG0); | 137 | r8a66597_bclr(r8a66597, SCKE, SYSCFG0); |
138 | udelay(1); | 138 | udelay(1); |
139 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | 139 | |
140 | #if defined(CONFIG_HAVE_CLK) | 140 | if (r8a66597->pdata->on_chip) { |
141 | clk_disable(r8a66597->clk); | 141 | #ifdef CONFIG_HAVE_CLK |
142 | #endif | 142 | clk_disable(r8a66597->clk); |
143 | #else | ||
144 | r8a66597_bclr(r8a66597, PLLC, SYSCFG0); | ||
145 | r8a66597_bclr(r8a66597, XCKE, SYSCFG0); | ||
146 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); | ||
147 | #endif | 143 | #endif |
144 | } else { | ||
145 | r8a66597_bclr(r8a66597, PLLC, SYSCFG0); | ||
146 | r8a66597_bclr(r8a66597, XCKE, SYSCFG0); | ||
147 | r8a66597_bclr(r8a66597, USBE, SYSCFG0); | ||
148 | } | ||
148 | } | 149 | } |
149 | 150 | ||
150 | static void r8a66597_enable_port(struct r8a66597 *r8a66597, int port) | 151 | static void r8a66597_enable_port(struct r8a66597 *r8a66597, int port) |
@@ -205,7 +206,7 @@ static int enable_controller(struct r8a66597 *r8a66597) | |||
205 | 206 | ||
206 | r8a66597_bset(r8a66597, SIGNE | SACKE, INTENB1); | 207 | r8a66597_bset(r8a66597, SIGNE | SACKE, INTENB1); |
207 | 208 | ||
208 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) | 209 | for (port = 0; port < r8a66597->max_root_hub; port++) |
209 | r8a66597_enable_port(r8a66597, port); | 210 | r8a66597_enable_port(r8a66597, port); |
210 | 211 | ||
211 | return 0; | 212 | return 0; |
@@ -218,7 +219,7 @@ static void disable_controller(struct r8a66597 *r8a66597) | |||
218 | r8a66597_write(r8a66597, 0, INTENB0); | 219 | r8a66597_write(r8a66597, 0, INTENB0); |
219 | r8a66597_write(r8a66597, 0, INTSTS0); | 220 | r8a66597_write(r8a66597, 0, INTSTS0); |
220 | 221 | ||
221 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) | 222 | for (port = 0; port < r8a66597->max_root_hub; port++) |
222 | r8a66597_disable_port(r8a66597, port); | 223 | r8a66597_disable_port(r8a66597, port); |
223 | 224 | ||
224 | r8a66597_clock_disable(r8a66597); | 225 | r8a66597_clock_disable(r8a66597); |
@@ -249,11 +250,12 @@ static int is_hub_limit(char *devpath) | |||
249 | return ((strlen(devpath) >= 4) ? 1 : 0); | 250 | return ((strlen(devpath) >= 4) ? 1 : 0); |
250 | } | 251 | } |
251 | 252 | ||
252 | static void get_port_number(char *devpath, u16 *root_port, u16 *hub_port) | 253 | static void get_port_number(struct r8a66597 *r8a66597, |
254 | char *devpath, u16 *root_port, u16 *hub_port) | ||
253 | { | 255 | { |
254 | if (root_port) { | 256 | if (root_port) { |
255 | *root_port = (devpath[0] & 0x0F) - 1; | 257 | *root_port = (devpath[0] & 0x0F) - 1; |
256 | if (*root_port >= R8A66597_MAX_ROOT_HUB) | 258 | if (*root_port >= r8a66597->max_root_hub) |
257 | printk(KERN_ERR "r8a66597: Illegal root port number.\n"); | 259 | printk(KERN_ERR "r8a66597: Illegal root port number.\n"); |
258 | } | 260 | } |
259 | if (hub_port) | 261 | if (hub_port) |
@@ -355,7 +357,8 @@ static int make_r8a66597_device(struct r8a66597 *r8a66597, | |||
355 | INIT_LIST_HEAD(&dev->device_list); | 357 | INIT_LIST_HEAD(&dev->device_list); |
356 | list_add_tail(&dev->device_list, &r8a66597->child_device); | 358 | list_add_tail(&dev->device_list, &r8a66597->child_device); |
357 | 359 | ||
358 | get_port_number(urb->dev->devpath, &dev->root_port, &dev->hub_port); | 360 | get_port_number(r8a66597, urb->dev->devpath, |
361 | &dev->root_port, &dev->hub_port); | ||
359 | if (!is_child_device(urb->dev->devpath)) | 362 | if (!is_child_device(urb->dev->devpath)) |
360 | r8a66597->root_hub[dev->root_port].dev = dev; | 363 | r8a66597->root_hub[dev->root_port].dev = dev; |
361 | 364 | ||
@@ -420,7 +423,7 @@ static void free_usb_address(struct r8a66597 *r8a66597, | |||
420 | list_del(&dev->device_list); | 423 | list_del(&dev->device_list); |
421 | kfree(dev); | 424 | kfree(dev); |
422 | 425 | ||
423 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) { | 426 | for (port = 0; port < r8a66597->max_root_hub; port++) { |
424 | if (r8a66597->root_hub[port].dev == dev) { | 427 | if (r8a66597->root_hub[port].dev == dev) { |
425 | r8a66597->root_hub[port].dev = NULL; | 428 | r8a66597->root_hub[port].dev = NULL; |
426 | break; | 429 | break; |
@@ -495,10 +498,20 @@ static void r8a66597_pipe_toggle(struct r8a66597 *r8a66597, | |||
495 | r8a66597_bset(r8a66597, SQCLR, pipe->pipectr); | 498 | r8a66597_bset(r8a66597, SQCLR, pipe->pipectr); |
496 | } | 499 | } |
497 | 500 | ||
501 | static inline unsigned short mbw_value(struct r8a66597 *r8a66597) | ||
502 | { | ||
503 | if (r8a66597->pdata->on_chip) | ||
504 | return MBW_32; | ||
505 | else | ||
506 | return MBW_16; | ||
507 | } | ||
508 | |||
498 | /* this function must be called with interrupt disabled */ | 509 | /* this function must be called with interrupt disabled */ |
499 | static inline void cfifo_change(struct r8a66597 *r8a66597, u16 pipenum) | 510 | static inline void cfifo_change(struct r8a66597 *r8a66597, u16 pipenum) |
500 | { | 511 | { |
501 | r8a66597_mdfy(r8a66597, MBW | pipenum, MBW | CURPIPE, CFIFOSEL); | 512 | unsigned short mbw = mbw_value(r8a66597); |
513 | |||
514 | r8a66597_mdfy(r8a66597, mbw | pipenum, mbw | CURPIPE, CFIFOSEL); | ||
502 | r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum); | 515 | r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum); |
503 | } | 516 | } |
504 | 517 | ||
@@ -506,11 +519,13 @@ static inline void cfifo_change(struct r8a66597 *r8a66597, u16 pipenum) | |||
506 | static inline void fifo_change_from_pipe(struct r8a66597 *r8a66597, | 519 | static inline void fifo_change_from_pipe(struct r8a66597 *r8a66597, |
507 | struct r8a66597_pipe *pipe) | 520 | struct r8a66597_pipe *pipe) |
508 | { | 521 | { |
522 | unsigned short mbw = mbw_value(r8a66597); | ||
523 | |||
509 | cfifo_change(r8a66597, 0); | 524 | cfifo_change(r8a66597, 0); |
510 | r8a66597_mdfy(r8a66597, MBW | 0, MBW | CURPIPE, D0FIFOSEL); | 525 | r8a66597_mdfy(r8a66597, mbw | 0, mbw | CURPIPE, D0FIFOSEL); |
511 | r8a66597_mdfy(r8a66597, MBW | 0, MBW | CURPIPE, D1FIFOSEL); | 526 | r8a66597_mdfy(r8a66597, mbw | 0, mbw | CURPIPE, D1FIFOSEL); |
512 | 527 | ||
513 | r8a66597_mdfy(r8a66597, MBW | pipe->info.pipenum, MBW | CURPIPE, | 528 | r8a66597_mdfy(r8a66597, mbw | pipe->info.pipenum, mbw | CURPIPE, |
514 | pipe->fifosel); | 529 | pipe->fifosel); |
515 | r8a66597_reg_wait(r8a66597, pipe->fifosel, CURPIPE, pipe->info.pipenum); | 530 | r8a66597_reg_wait(r8a66597, pipe->fifosel, CURPIPE, pipe->info.pipenum); |
516 | } | 531 | } |
@@ -742,9 +757,13 @@ static void enable_r8a66597_pipe_dma(struct r8a66597 *r8a66597, | |||
742 | struct r8a66597_pipe *pipe, | 757 | struct r8a66597_pipe *pipe, |
743 | struct urb *urb) | 758 | struct urb *urb) |
744 | { | 759 | { |
745 | #if !defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | ||
746 | int i; | 760 | int i; |
747 | struct r8a66597_pipe_info *info = &pipe->info; | 761 | struct r8a66597_pipe_info *info = &pipe->info; |
762 | unsigned short mbw = mbw_value(r8a66597); | ||
763 | |||
764 | /* pipe dma is only for external controlles */ | ||
765 | if (r8a66597->pdata->on_chip) | ||
766 | return; | ||
748 | 767 | ||
749 | if ((pipe->info.pipenum != 0) && (info->type != R8A66597_INT)) { | 768 | if ((pipe->info.pipenum != 0) && (info->type != R8A66597_INT)) { |
750 | for (i = 0; i < R8A66597_MAX_DMA_CHANNEL; i++) { | 769 | for (i = 0; i < R8A66597_MAX_DMA_CHANNEL; i++) { |
@@ -763,8 +782,8 @@ static void enable_r8a66597_pipe_dma(struct r8a66597 *r8a66597, | |||
763 | set_pipe_reg_addr(pipe, i); | 782 | set_pipe_reg_addr(pipe, i); |
764 | 783 | ||
765 | cfifo_change(r8a66597, 0); | 784 | cfifo_change(r8a66597, 0); |
766 | r8a66597_mdfy(r8a66597, MBW | pipe->info.pipenum, | 785 | r8a66597_mdfy(r8a66597, mbw | pipe->info.pipenum, |
767 | MBW | CURPIPE, pipe->fifosel); | 786 | mbw | CURPIPE, pipe->fifosel); |
768 | 787 | ||
769 | r8a66597_reg_wait(r8a66597, pipe->fifosel, CURPIPE, | 788 | r8a66597_reg_wait(r8a66597, pipe->fifosel, CURPIPE, |
770 | pipe->info.pipenum); | 789 | pipe->info.pipenum); |
@@ -772,7 +791,6 @@ static void enable_r8a66597_pipe_dma(struct r8a66597 *r8a66597, | |||
772 | break; | 791 | break; |
773 | } | 792 | } |
774 | } | 793 | } |
775 | #endif /* #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) */ | ||
776 | } | 794 | } |
777 | 795 | ||
778 | /* this function must be called with interrupt disabled */ | 796 | /* this function must be called with interrupt disabled */ |
@@ -1769,7 +1787,7 @@ static void r8a66597_timer(unsigned long _r8a66597) | |||
1769 | 1787 | ||
1770 | spin_lock_irqsave(&r8a66597->lock, flags); | 1788 | spin_lock_irqsave(&r8a66597->lock, flags); |
1771 | 1789 | ||
1772 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) | 1790 | for (port = 0; port < r8a66597->max_root_hub; port++) |
1773 | r8a66597_root_hub_control(r8a66597, port); | 1791 | r8a66597_root_hub_control(r8a66597, port); |
1774 | 1792 | ||
1775 | spin_unlock_irqrestore(&r8a66597->lock, flags); | 1793 | spin_unlock_irqrestore(&r8a66597->lock, flags); |
@@ -1807,7 +1825,7 @@ static void set_address_zero(struct r8a66597 *r8a66597, struct urb *urb) | |||
1807 | u16 root_port, hub_port; | 1825 | u16 root_port, hub_port; |
1808 | 1826 | ||
1809 | if (usb_address == 0) { | 1827 | if (usb_address == 0) { |
1810 | get_port_number(urb->dev->devpath, | 1828 | get_port_number(r8a66597, urb->dev->devpath, |
1811 | &root_port, &hub_port); | 1829 | &root_port, &hub_port); |
1812 | set_devadd_reg(r8a66597, 0, | 1830 | set_devadd_reg(r8a66597, 0, |
1813 | get_r8a66597_usb_speed(urb->dev->speed), | 1831 | get_r8a66597_usb_speed(urb->dev->speed), |
@@ -2082,7 +2100,7 @@ static int r8a66597_hub_status_data(struct usb_hcd *hcd, char *buf) | |||
2082 | 2100 | ||
2083 | *buf = 0; /* initialize (no change) */ | 2101 | *buf = 0; /* initialize (no change) */ |
2084 | 2102 | ||
2085 | for (i = 0; i < R8A66597_MAX_ROOT_HUB; i++) { | 2103 | for (i = 0; i < r8a66597->max_root_hub; i++) { |
2086 | if (r8a66597->root_hub[i].port & 0xffff0000) | 2104 | if (r8a66597->root_hub[i].port & 0xffff0000) |
2087 | *buf |= 1 << (i + 1); | 2105 | *buf |= 1 << (i + 1); |
2088 | } | 2106 | } |
@@ -2097,11 +2115,11 @@ static void r8a66597_hub_descriptor(struct r8a66597 *r8a66597, | |||
2097 | { | 2115 | { |
2098 | desc->bDescriptorType = 0x29; | 2116 | desc->bDescriptorType = 0x29; |
2099 | desc->bHubContrCurrent = 0; | 2117 | desc->bHubContrCurrent = 0; |
2100 | desc->bNbrPorts = R8A66597_MAX_ROOT_HUB; | 2118 | desc->bNbrPorts = r8a66597->max_root_hub; |
2101 | desc->bDescLength = 9; | 2119 | desc->bDescLength = 9; |
2102 | desc->bPwrOn2PwrGood = 0; | 2120 | desc->bPwrOn2PwrGood = 0; |
2103 | desc->wHubCharacteristics = cpu_to_le16(0x0011); | 2121 | desc->wHubCharacteristics = cpu_to_le16(0x0011); |
2104 | desc->bitmap[0] = ((1 << R8A66597_MAX_ROOT_HUB) - 1) << 1; | 2122 | desc->bitmap[0] = ((1 << r8a66597->max_root_hub) - 1) << 1; |
2105 | desc->bitmap[1] = ~0; | 2123 | desc->bitmap[1] = ~0; |
2106 | } | 2124 | } |
2107 | 2125 | ||
@@ -2129,7 +2147,7 @@ static int r8a66597_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, | |||
2129 | } | 2147 | } |
2130 | break; | 2148 | break; |
2131 | case ClearPortFeature: | 2149 | case ClearPortFeature: |
2132 | if (wIndex > R8A66597_MAX_ROOT_HUB) | 2150 | if (wIndex > r8a66597->max_root_hub) |
2133 | goto error; | 2151 | goto error; |
2134 | if (wLength != 0) | 2152 | if (wLength != 0) |
2135 | goto error; | 2153 | goto error; |
@@ -2162,12 +2180,12 @@ static int r8a66597_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, | |||
2162 | *buf = 0x00; | 2180 | *buf = 0x00; |
2163 | break; | 2181 | break; |
2164 | case GetPortStatus: | 2182 | case GetPortStatus: |
2165 | if (wIndex > R8A66597_MAX_ROOT_HUB) | 2183 | if (wIndex > r8a66597->max_root_hub) |
2166 | goto error; | 2184 | goto error; |
2167 | *(__le32 *)buf = cpu_to_le32(rh->port); | 2185 | *(__le32 *)buf = cpu_to_le32(rh->port); |
2168 | break; | 2186 | break; |
2169 | case SetPortFeature: | 2187 | case SetPortFeature: |
2170 | if (wIndex > R8A66597_MAX_ROOT_HUB) | 2188 | if (wIndex > r8a66597->max_root_hub) |
2171 | goto error; | 2189 | goto error; |
2172 | if (wLength != 0) | 2190 | if (wLength != 0) |
2173 | goto error; | 2191 | goto error; |
@@ -2216,7 +2234,7 @@ static int r8a66597_bus_suspend(struct usb_hcd *hcd) | |||
2216 | 2234 | ||
2217 | dbg("%s", __func__); | 2235 | dbg("%s", __func__); |
2218 | 2236 | ||
2219 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) { | 2237 | for (port = 0; port < r8a66597->max_root_hub; port++) { |
2220 | struct r8a66597_root_hub *rh = &r8a66597->root_hub[port]; | 2238 | struct r8a66597_root_hub *rh = &r8a66597->root_hub[port]; |
2221 | unsigned long dvstctr_reg = get_dvstctr_reg(port); | 2239 | unsigned long dvstctr_reg = get_dvstctr_reg(port); |
2222 | 2240 | ||
@@ -2247,7 +2265,7 @@ static int r8a66597_bus_resume(struct usb_hcd *hcd) | |||
2247 | 2265 | ||
2248 | dbg("%s", __func__); | 2266 | dbg("%s", __func__); |
2249 | 2267 | ||
2250 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) { | 2268 | for (port = 0; port < r8a66597->max_root_hub; port++) { |
2251 | struct r8a66597_root_hub *rh = &r8a66597->root_hub[port]; | 2269 | struct r8a66597_root_hub *rh = &r8a66597->root_hub[port]; |
2252 | unsigned long dvstctr_reg = get_dvstctr_reg(port); | 2270 | unsigned long dvstctr_reg = get_dvstctr_reg(port); |
2253 | 2271 | ||
@@ -2305,16 +2323,16 @@ static struct hc_driver r8a66597_hc_driver = { | |||
2305 | }; | 2323 | }; |
2306 | 2324 | ||
2307 | #if defined(CONFIG_PM) | 2325 | #if defined(CONFIG_PM) |
2308 | static int r8a66597_suspend(struct platform_device *pdev, pm_message_t state) | 2326 | static int r8a66597_suspend(struct device *dev) |
2309 | { | 2327 | { |
2310 | struct r8a66597 *r8a66597 = dev_get_drvdata(&pdev->dev); | 2328 | struct r8a66597 *r8a66597 = dev_get_drvdata(dev); |
2311 | int port; | 2329 | int port; |
2312 | 2330 | ||
2313 | dbg("%s", __func__); | 2331 | dbg("%s", __func__); |
2314 | 2332 | ||
2315 | disable_controller(r8a66597); | 2333 | disable_controller(r8a66597); |
2316 | 2334 | ||
2317 | for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++) { | 2335 | for (port = 0; port < r8a66597->max_root_hub; port++) { |
2318 | struct r8a66597_root_hub *rh = &r8a66597->root_hub[port]; | 2336 | struct r8a66597_root_hub *rh = &r8a66597->root_hub[port]; |
2319 | 2337 | ||
2320 | rh->port = 0x00000000; | 2338 | rh->port = 0x00000000; |
@@ -2323,9 +2341,9 @@ static int r8a66597_suspend(struct platform_device *pdev, pm_message_t state) | |||
2323 | return 0; | 2341 | return 0; |
2324 | } | 2342 | } |
2325 | 2343 | ||
2326 | static int r8a66597_resume(struct platform_device *pdev) | 2344 | static int r8a66597_resume(struct device *dev) |
2327 | { | 2345 | { |
2328 | struct r8a66597 *r8a66597 = dev_get_drvdata(&pdev->dev); | 2346 | struct r8a66597 *r8a66597 = dev_get_drvdata(dev); |
2329 | struct usb_hcd *hcd = r8a66597_to_hcd(r8a66597); | 2347 | struct usb_hcd *hcd = r8a66597_to_hcd(r8a66597); |
2330 | 2348 | ||
2331 | dbg("%s", __func__); | 2349 | dbg("%s", __func__); |
@@ -2335,9 +2353,17 @@ static int r8a66597_resume(struct platform_device *pdev) | |||
2335 | 2353 | ||
2336 | return 0; | 2354 | return 0; |
2337 | } | 2355 | } |
2356 | |||
2357 | static struct dev_pm_ops r8a66597_dev_pm_ops = { | ||
2358 | .suspend = r8a66597_suspend, | ||
2359 | .resume = r8a66597_resume, | ||
2360 | .poweroff = r8a66597_suspend, | ||
2361 | .restore = r8a66597_resume, | ||
2362 | }; | ||
2363 | |||
2364 | #define R8A66597_DEV_PM_OPS (&r8a66597_dev_pm_ops) | ||
2338 | #else /* if defined(CONFIG_PM) */ | 2365 | #else /* if defined(CONFIG_PM) */ |
2339 | #define r8a66597_suspend NULL | 2366 | #define R8A66597_DEV_PM_OPS NULL |
2340 | #define r8a66597_resume NULL | ||
2341 | #endif | 2367 | #endif |
2342 | 2368 | ||
2343 | static int __init_or_module r8a66597_remove(struct platform_device *pdev) | 2369 | static int __init_or_module r8a66597_remove(struct platform_device *pdev) |
@@ -2348,8 +2374,9 @@ static int __init_or_module r8a66597_remove(struct platform_device *pdev) | |||
2348 | del_timer_sync(&r8a66597->rh_timer); | 2374 | del_timer_sync(&r8a66597->rh_timer); |
2349 | usb_remove_hcd(hcd); | 2375 | usb_remove_hcd(hcd); |
2350 | iounmap((void *)r8a66597->reg); | 2376 | iounmap((void *)r8a66597->reg); |
2351 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) && defined(CONFIG_HAVE_CLK) | 2377 | #ifdef CONFIG_HAVE_CLK |
2352 | clk_put(r8a66597->clk); | 2378 | if (r8a66597->pdata->on_chip) |
2379 | clk_put(r8a66597->clk); | ||
2353 | #endif | 2380 | #endif |
2354 | usb_put_hcd(hcd); | 2381 | usb_put_hcd(hcd); |
2355 | return 0; | 2382 | return 0; |
@@ -2357,7 +2384,7 @@ static int __init_or_module r8a66597_remove(struct platform_device *pdev) | |||
2357 | 2384 | ||
2358 | static int __devinit r8a66597_probe(struct platform_device *pdev) | 2385 | static int __devinit r8a66597_probe(struct platform_device *pdev) |
2359 | { | 2386 | { |
2360 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) && defined(CONFIG_HAVE_CLK) | 2387 | #ifdef CONFIG_HAVE_CLK |
2361 | char clk_name[8]; | 2388 | char clk_name[8]; |
2362 | #endif | 2389 | #endif |
2363 | struct resource *res = NULL, *ires; | 2390 | struct resource *res = NULL, *ires; |
@@ -2419,15 +2446,20 @@ static int __devinit r8a66597_probe(struct platform_device *pdev) | |||
2419 | r8a66597->pdata = pdev->dev.platform_data; | 2446 | r8a66597->pdata = pdev->dev.platform_data; |
2420 | r8a66597->irq_sense_low = irq_trigger == IRQF_TRIGGER_LOW; | 2447 | r8a66597->irq_sense_low = irq_trigger == IRQF_TRIGGER_LOW; |
2421 | 2448 | ||
2422 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) && defined(CONFIG_HAVE_CLK) | 2449 | if (r8a66597->pdata->on_chip) { |
2423 | snprintf(clk_name, sizeof(clk_name), "usb%d", pdev->id); | 2450 | #ifdef CONFIG_HAVE_CLK |
2424 | r8a66597->clk = clk_get(&pdev->dev, clk_name); | 2451 | snprintf(clk_name, sizeof(clk_name), "usb%d", pdev->id); |
2425 | if (IS_ERR(r8a66597->clk)) { | 2452 | r8a66597->clk = clk_get(&pdev->dev, clk_name); |
2426 | dev_err(&pdev->dev, "cannot get clock \"%s\"\n", clk_name); | 2453 | if (IS_ERR(r8a66597->clk)) { |
2427 | ret = PTR_ERR(r8a66597->clk); | 2454 | dev_err(&pdev->dev, "cannot get clock \"%s\"\n", |
2428 | goto clean_up2; | 2455 | clk_name); |
2429 | } | 2456 | ret = PTR_ERR(r8a66597->clk); |
2457 | goto clean_up2; | ||
2458 | } | ||
2430 | #endif | 2459 | #endif |
2460 | r8a66597->max_root_hub = 1; | ||
2461 | } else | ||
2462 | r8a66597->max_root_hub = 2; | ||
2431 | 2463 | ||
2432 | spin_lock_init(&r8a66597->lock); | 2464 | spin_lock_init(&r8a66597->lock); |
2433 | init_timer(&r8a66597->rh_timer); | 2465 | init_timer(&r8a66597->rh_timer); |
@@ -2457,8 +2489,9 @@ static int __devinit r8a66597_probe(struct platform_device *pdev) | |||
2457 | return 0; | 2489 | return 0; |
2458 | 2490 | ||
2459 | clean_up3: | 2491 | clean_up3: |
2460 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) && defined(CONFIG_HAVE_CLK) | 2492 | #ifdef CONFIG_HAVE_CLK |
2461 | clk_put(r8a66597->clk); | 2493 | if (r8a66597->pdata->on_chip) |
2494 | clk_put(r8a66597->clk); | ||
2462 | clean_up2: | 2495 | clean_up2: |
2463 | #endif | 2496 | #endif |
2464 | usb_put_hcd(hcd); | 2497 | usb_put_hcd(hcd); |
@@ -2473,11 +2506,10 @@ clean_up: | |||
2473 | static struct platform_driver r8a66597_driver = { | 2506 | static struct platform_driver r8a66597_driver = { |
2474 | .probe = r8a66597_probe, | 2507 | .probe = r8a66597_probe, |
2475 | .remove = r8a66597_remove, | 2508 | .remove = r8a66597_remove, |
2476 | .suspend = r8a66597_suspend, | ||
2477 | .resume = r8a66597_resume, | ||
2478 | .driver = { | 2509 | .driver = { |
2479 | .name = (char *) hcd_name, | 2510 | .name = (char *) hcd_name, |
2480 | .owner = THIS_MODULE, | 2511 | .owner = THIS_MODULE, |
2512 | .pm = R8A66597_DEV_PM_OPS, | ||
2481 | }, | 2513 | }, |
2482 | }; | 2514 | }; |
2483 | 2515 | ||
diff --git a/drivers/usb/host/r8a66597.h b/drivers/usb/host/r8a66597.h index d72680b433f9..228e3fb23854 100644 --- a/drivers/usb/host/r8a66597.h +++ b/drivers/usb/host/r8a66597.h | |||
@@ -26,390 +26,16 @@ | |||
26 | #ifndef __R8A66597_H__ | 26 | #ifndef __R8A66597_H__ |
27 | #define __R8A66597_H__ | 27 | #define __R8A66597_H__ |
28 | 28 | ||
29 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) && defined(CONFIG_HAVE_CLK) | 29 | #ifdef CONFIG_HAVE_CLK |
30 | #include <linux/clk.h> | 30 | #include <linux/clk.h> |
31 | #endif | 31 | #endif |
32 | 32 | ||
33 | #include <linux/usb/r8a66597.h> | 33 | #include <linux/usb/r8a66597.h> |
34 | 34 | ||
35 | #define SYSCFG0 0x00 | ||
36 | #define SYSCFG1 0x02 | ||
37 | #define SYSSTS0 0x04 | ||
38 | #define SYSSTS1 0x06 | ||
39 | #define DVSTCTR0 0x08 | ||
40 | #define DVSTCTR1 0x0A | ||
41 | #define TESTMODE 0x0C | ||
42 | #define PINCFG 0x0E | ||
43 | #define DMA0CFG 0x10 | ||
44 | #define DMA1CFG 0x12 | ||
45 | #define CFIFO 0x14 | ||
46 | #define D0FIFO 0x18 | ||
47 | #define D1FIFO 0x1C | ||
48 | #define CFIFOSEL 0x20 | ||
49 | #define CFIFOCTR 0x22 | ||
50 | #define CFIFOSIE 0x24 | ||
51 | #define D0FIFOSEL 0x28 | ||
52 | #define D0FIFOCTR 0x2A | ||
53 | #define D1FIFOSEL 0x2C | ||
54 | #define D1FIFOCTR 0x2E | ||
55 | #define INTENB0 0x30 | ||
56 | #define INTENB1 0x32 | ||
57 | #define INTENB2 0x34 | ||
58 | #define BRDYENB 0x36 | ||
59 | #define NRDYENB 0x38 | ||
60 | #define BEMPENB 0x3A | ||
61 | #define SOFCFG 0x3C | ||
62 | #define INTSTS0 0x40 | ||
63 | #define INTSTS1 0x42 | ||
64 | #define INTSTS2 0x44 | ||
65 | #define BRDYSTS 0x46 | ||
66 | #define NRDYSTS 0x48 | ||
67 | #define BEMPSTS 0x4A | ||
68 | #define FRMNUM 0x4C | ||
69 | #define UFRMNUM 0x4E | ||
70 | #define USBADDR 0x50 | ||
71 | #define USBREQ 0x54 | ||
72 | #define USBVAL 0x56 | ||
73 | #define USBINDX 0x58 | ||
74 | #define USBLENG 0x5A | ||
75 | #define DCPCFG 0x5C | ||
76 | #define DCPMAXP 0x5E | ||
77 | #define DCPCTR 0x60 | ||
78 | #define PIPESEL 0x64 | ||
79 | #define PIPECFG 0x68 | ||
80 | #define PIPEBUF 0x6A | ||
81 | #define PIPEMAXP 0x6C | ||
82 | #define PIPEPERI 0x6E | ||
83 | #define PIPE1CTR 0x70 | ||
84 | #define PIPE2CTR 0x72 | ||
85 | #define PIPE3CTR 0x74 | ||
86 | #define PIPE4CTR 0x76 | ||
87 | #define PIPE5CTR 0x78 | ||
88 | #define PIPE6CTR 0x7A | ||
89 | #define PIPE7CTR 0x7C | ||
90 | #define PIPE8CTR 0x7E | ||
91 | #define PIPE9CTR 0x80 | ||
92 | #define PIPE1TRE 0x90 | ||
93 | #define PIPE1TRN 0x92 | ||
94 | #define PIPE2TRE 0x94 | ||
95 | #define PIPE2TRN 0x96 | ||
96 | #define PIPE3TRE 0x98 | ||
97 | #define PIPE3TRN 0x9A | ||
98 | #define PIPE4TRE 0x9C | ||
99 | #define PIPE4TRN 0x9E | ||
100 | #define PIPE5TRE 0xA0 | ||
101 | #define PIPE5TRN 0xA2 | ||
102 | #define DEVADD0 0xD0 | ||
103 | #define DEVADD1 0xD2 | ||
104 | #define DEVADD2 0xD4 | ||
105 | #define DEVADD3 0xD6 | ||
106 | #define DEVADD4 0xD8 | ||
107 | #define DEVADD5 0xDA | ||
108 | #define DEVADD6 0xDC | ||
109 | #define DEVADD7 0xDE | ||
110 | #define DEVADD8 0xE0 | ||
111 | #define DEVADD9 0xE2 | ||
112 | #define DEVADDA 0xE4 | ||
113 | |||
114 | /* System Configuration Control Register */ | ||
115 | #define XTAL 0xC000 /* b15-14: Crystal selection */ | ||
116 | #define XTAL48 0x8000 /* 48MHz */ | ||
117 | #define XTAL24 0x4000 /* 24MHz */ | ||
118 | #define XTAL12 0x0000 /* 12MHz */ | ||
119 | #define XCKE 0x2000 /* b13: External clock enable */ | ||
120 | #define PLLC 0x0800 /* b11: PLL control */ | ||
121 | #define SCKE 0x0400 /* b10: USB clock enable */ | ||
122 | #define PCSDIS 0x0200 /* b9: not CS wakeup */ | ||
123 | #define LPSME 0x0100 /* b8: Low power sleep mode */ | ||
124 | #define HSE 0x0080 /* b7: Hi-speed enable */ | ||
125 | #define DCFM 0x0040 /* b6: Controller function select */ | ||
126 | #define DRPD 0x0020 /* b5: D+/- pull down control */ | ||
127 | #define DPRPU 0x0010 /* b4: D+ pull up control */ | ||
128 | #define USBE 0x0001 /* b0: USB module operation enable */ | ||
129 | |||
130 | /* System Configuration Status Register */ | ||
131 | #define OVCBIT 0x8000 /* b15-14: Over-current bit */ | ||
132 | #define OVCMON 0xC000 /* b15-14: Over-current monitor */ | ||
133 | #define SOFEA 0x0020 /* b5: SOF monitor */ | ||
134 | #define IDMON 0x0004 /* b3: ID-pin monitor */ | ||
135 | #define LNST 0x0003 /* b1-0: D+, D- line status */ | ||
136 | #define SE1 0x0003 /* SE1 */ | ||
137 | #define FS_KSTS 0x0002 /* Full-Speed K State */ | ||
138 | #define FS_JSTS 0x0001 /* Full-Speed J State */ | ||
139 | #define LS_JSTS 0x0002 /* Low-Speed J State */ | ||
140 | #define LS_KSTS 0x0001 /* Low-Speed K State */ | ||
141 | #define SE0 0x0000 /* SE0 */ | ||
142 | |||
143 | /* Device State Control Register */ | ||
144 | #define EXTLP0 0x0400 /* b10: External port */ | ||
145 | #define VBOUT 0x0200 /* b9: VBUS output */ | ||
146 | #define WKUP 0x0100 /* b8: Remote wakeup */ | ||
147 | #define RWUPE 0x0080 /* b7: Remote wakeup sense */ | ||
148 | #define USBRST 0x0040 /* b6: USB reset enable */ | ||
149 | #define RESUME 0x0020 /* b5: Resume enable */ | ||
150 | #define UACT 0x0010 /* b4: USB bus enable */ | ||
151 | #define RHST 0x0007 /* b1-0: Reset handshake status */ | ||
152 | #define HSPROC 0x0004 /* HS handshake is processing */ | ||
153 | #define HSMODE 0x0003 /* Hi-Speed mode */ | ||
154 | #define FSMODE 0x0002 /* Full-Speed mode */ | ||
155 | #define LSMODE 0x0001 /* Low-Speed mode */ | ||
156 | #define UNDECID 0x0000 /* Undecided */ | ||
157 | |||
158 | /* Test Mode Register */ | ||
159 | #define UTST 0x000F /* b3-0: Test select */ | ||
160 | #define H_TST_PACKET 0x000C /* HOST TEST Packet */ | ||
161 | #define H_TST_SE0_NAK 0x000B /* HOST TEST SE0 NAK */ | ||
162 | #define H_TST_K 0x000A /* HOST TEST K */ | ||
163 | #define H_TST_J 0x0009 /* HOST TEST J */ | ||
164 | #define H_TST_NORMAL 0x0000 /* HOST Normal Mode */ | ||
165 | #define P_TST_PACKET 0x0004 /* PERI TEST Packet */ | ||
166 | #define P_TST_SE0_NAK 0x0003 /* PERI TEST SE0 NAK */ | ||
167 | #define P_TST_K 0x0002 /* PERI TEST K */ | ||
168 | #define P_TST_J 0x0001 /* PERI TEST J */ | ||
169 | #define P_TST_NORMAL 0x0000 /* PERI Normal Mode */ | ||
170 | |||
171 | /* Data Pin Configuration Register */ | ||
172 | #define LDRV 0x8000 /* b15: Drive Current Adjust */ | ||
173 | #define VIF1 0x0000 /* VIF = 1.8V */ | ||
174 | #define VIF3 0x8000 /* VIF = 3.3V */ | ||
175 | #define INTA 0x0001 /* b1: USB INT-pin active */ | ||
176 | |||
177 | /* DMAx Pin Configuration Register */ | ||
178 | #define DREQA 0x4000 /* b14: Dreq active select */ | ||
179 | #define BURST 0x2000 /* b13: Burst mode */ | ||
180 | #define DACKA 0x0400 /* b10: Dack active select */ | ||
181 | #define DFORM 0x0380 /* b9-7: DMA mode select */ | ||
182 | #define CPU_ADR_RD_WR 0x0000 /* Address + RD/WR mode (CPU bus) */ | ||
183 | #define CPU_DACK_RD_WR 0x0100 /* DACK + RD/WR mode (CPU bus) */ | ||
184 | #define CPU_DACK_ONLY 0x0180 /* DACK only mode (CPU bus) */ | ||
185 | #define SPLIT_DACK_ONLY 0x0200 /* DACK only mode (SPLIT bus) */ | ||
186 | #define DENDA 0x0040 /* b6: Dend active select */ | ||
187 | #define PKTM 0x0020 /* b5: Packet mode */ | ||
188 | #define DENDE 0x0010 /* b4: Dend enable */ | ||
189 | #define OBUS 0x0004 /* b2: OUTbus mode */ | ||
190 | |||
191 | /* CFIFO/DxFIFO Port Select Register */ | ||
192 | #define RCNT 0x8000 /* b15: Read count mode */ | ||
193 | #define REW 0x4000 /* b14: Buffer rewind */ | ||
194 | #define DCLRM 0x2000 /* b13: DMA buffer clear mode */ | ||
195 | #define DREQE 0x1000 /* b12: DREQ output enable */ | ||
196 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | ||
197 | #define MBW 0x0800 | ||
198 | #else | ||
199 | #define MBW 0x0400 /* b10: Maximum bit width for FIFO access */ | ||
200 | #endif | ||
201 | #define MBW_8 0x0000 /* 8bit */ | ||
202 | #define MBW_16 0x0400 /* 16bit */ | ||
203 | #define BIGEND 0x0100 /* b8: Big endian mode */ | ||
204 | #define BYTE_LITTLE 0x0000 /* little dendian */ | ||
205 | #define BYTE_BIG 0x0100 /* big endifan */ | ||
206 | #define ISEL 0x0020 /* b5: DCP FIFO port direction select */ | ||
207 | #define CURPIPE 0x000F /* b2-0: PIPE select */ | ||
208 | |||
209 | /* CFIFO/DxFIFO Port Control Register */ | ||
210 | #define BVAL 0x8000 /* b15: Buffer valid flag */ | ||
211 | #define BCLR 0x4000 /* b14: Buffer clear */ | ||
212 | #define FRDY 0x2000 /* b13: FIFO ready */ | ||
213 | #define DTLN 0x0FFF /* b11-0: FIFO received data length */ | ||
214 | |||
215 | /* Interrupt Enable Register 0 */ | ||
216 | #define VBSE 0x8000 /* b15: VBUS interrupt */ | ||
217 | #define RSME 0x4000 /* b14: Resume interrupt */ | ||
218 | #define SOFE 0x2000 /* b13: Frame update interrupt */ | ||
219 | #define DVSE 0x1000 /* b12: Device state transition interrupt */ | ||
220 | #define CTRE 0x0800 /* b11: Control transfer stage transition interrupt */ | ||
221 | #define BEMPE 0x0400 /* b10: Buffer empty interrupt */ | ||
222 | #define NRDYE 0x0200 /* b9: Buffer not ready interrupt */ | ||
223 | #define BRDYE 0x0100 /* b8: Buffer ready interrupt */ | ||
224 | |||
225 | /* Interrupt Enable Register 1 */ | ||
226 | #define OVRCRE 0x8000 /* b15: Over-current interrupt */ | ||
227 | #define BCHGE 0x4000 /* b14: USB us chenge interrupt */ | ||
228 | #define DTCHE 0x1000 /* b12: Detach sense interrupt */ | ||
229 | #define ATTCHE 0x0800 /* b11: Attach sense interrupt */ | ||
230 | #define EOFERRE 0x0040 /* b6: EOF error interrupt */ | ||
231 | #define SIGNE 0x0020 /* b5: SETUP IGNORE interrupt */ | ||
232 | #define SACKE 0x0010 /* b4: SETUP ACK interrupt */ | ||
233 | |||
234 | /* BRDY Interrupt Enable/Status Register */ | ||
235 | #define BRDY9 0x0200 /* b9: PIPE9 */ | ||
236 | #define BRDY8 0x0100 /* b8: PIPE8 */ | ||
237 | #define BRDY7 0x0080 /* b7: PIPE7 */ | ||
238 | #define BRDY6 0x0040 /* b6: PIPE6 */ | ||
239 | #define BRDY5 0x0020 /* b5: PIPE5 */ | ||
240 | #define BRDY4 0x0010 /* b4: PIPE4 */ | ||
241 | #define BRDY3 0x0008 /* b3: PIPE3 */ | ||
242 | #define BRDY2 0x0004 /* b2: PIPE2 */ | ||
243 | #define BRDY1 0x0002 /* b1: PIPE1 */ | ||
244 | #define BRDY0 0x0001 /* b1: PIPE0 */ | ||
245 | |||
246 | /* NRDY Interrupt Enable/Status Register */ | ||
247 | #define NRDY9 0x0200 /* b9: PIPE9 */ | ||
248 | #define NRDY8 0x0100 /* b8: PIPE8 */ | ||
249 | #define NRDY7 0x0080 /* b7: PIPE7 */ | ||
250 | #define NRDY6 0x0040 /* b6: PIPE6 */ | ||
251 | #define NRDY5 0x0020 /* b5: PIPE5 */ | ||
252 | #define NRDY4 0x0010 /* b4: PIPE4 */ | ||
253 | #define NRDY3 0x0008 /* b3: PIPE3 */ | ||
254 | #define NRDY2 0x0004 /* b2: PIPE2 */ | ||
255 | #define NRDY1 0x0002 /* b1: PIPE1 */ | ||
256 | #define NRDY0 0x0001 /* b1: PIPE0 */ | ||
257 | |||
258 | /* BEMP Interrupt Enable/Status Register */ | ||
259 | #define BEMP9 0x0200 /* b9: PIPE9 */ | ||
260 | #define BEMP8 0x0100 /* b8: PIPE8 */ | ||
261 | #define BEMP7 0x0080 /* b7: PIPE7 */ | ||
262 | #define BEMP6 0x0040 /* b6: PIPE6 */ | ||
263 | #define BEMP5 0x0020 /* b5: PIPE5 */ | ||
264 | #define BEMP4 0x0010 /* b4: PIPE4 */ | ||
265 | #define BEMP3 0x0008 /* b3: PIPE3 */ | ||
266 | #define BEMP2 0x0004 /* b2: PIPE2 */ | ||
267 | #define BEMP1 0x0002 /* b1: PIPE1 */ | ||
268 | #define BEMP0 0x0001 /* b0: PIPE0 */ | ||
269 | |||
270 | /* SOF Pin Configuration Register */ | ||
271 | #define TRNENSEL 0x0100 /* b8: Select transaction enable period */ | ||
272 | #define BRDYM 0x0040 /* b6: BRDY clear timing */ | ||
273 | #define INTL 0x0020 /* b5: Interrupt sense select */ | ||
274 | #define EDGESTS 0x0010 /* b4: */ | ||
275 | #define SOFMODE 0x000C /* b3-2: SOF pin select */ | ||
276 | #define SOF_125US 0x0008 /* SOF OUT 125us Frame Signal */ | ||
277 | #define SOF_1MS 0x0004 /* SOF OUT 1ms Frame Signal */ | ||
278 | #define SOF_DISABLE 0x0000 /* SOF OUT Disable */ | ||
279 | |||
280 | /* Interrupt Status Register 0 */ | ||
281 | #define VBINT 0x8000 /* b15: VBUS interrupt */ | ||
282 | #define RESM 0x4000 /* b14: Resume interrupt */ | ||
283 | #define SOFR 0x2000 /* b13: SOF frame update interrupt */ | ||
284 | #define DVST 0x1000 /* b12: Device state transition interrupt */ | ||
285 | #define CTRT 0x0800 /* b11: Control transfer stage transition interrupt */ | ||
286 | #define BEMP 0x0400 /* b10: Buffer empty interrupt */ | ||
287 | #define NRDY 0x0200 /* b9: Buffer not ready interrupt */ | ||
288 | #define BRDY 0x0100 /* b8: Buffer ready interrupt */ | ||
289 | #define VBSTS 0x0080 /* b7: VBUS input port */ | ||
290 | #define DVSQ 0x0070 /* b6-4: Device state */ | ||
291 | #define DS_SPD_CNFG 0x0070 /* Suspend Configured */ | ||
292 | #define DS_SPD_ADDR 0x0060 /* Suspend Address */ | ||
293 | #define DS_SPD_DFLT 0x0050 /* Suspend Default */ | ||
294 | #define DS_SPD_POWR 0x0040 /* Suspend Powered */ | ||
295 | #define DS_SUSP 0x0040 /* Suspend */ | ||
296 | #define DS_CNFG 0x0030 /* Configured */ | ||
297 | #define DS_ADDS 0x0020 /* Address */ | ||
298 | #define DS_DFLT 0x0010 /* Default */ | ||
299 | #define DS_POWR 0x0000 /* Powered */ | ||
300 | #define DVSQS 0x0030 /* b5-4: Device state */ | ||
301 | #define VALID 0x0008 /* b3: Setup packet detected flag */ | ||
302 | #define CTSQ 0x0007 /* b2-0: Control transfer stage */ | ||
303 | #define CS_SQER 0x0006 /* Sequence error */ | ||
304 | #define CS_WRND 0x0005 /* Control write nodata status stage */ | ||
305 | #define CS_WRSS 0x0004 /* Control write status stage */ | ||
306 | #define CS_WRDS 0x0003 /* Control write data stage */ | ||
307 | #define CS_RDSS 0x0002 /* Control read status stage */ | ||
308 | #define CS_RDDS 0x0001 /* Control read data stage */ | ||
309 | #define CS_IDST 0x0000 /* Idle or setup stage */ | ||
310 | |||
311 | /* Interrupt Status Register 1 */ | ||
312 | #define OVRCR 0x8000 /* b15: Over-current interrupt */ | ||
313 | #define BCHG 0x4000 /* b14: USB bus chenge interrupt */ | ||
314 | #define DTCH 0x1000 /* b12: Detach sense interrupt */ | ||
315 | #define ATTCH 0x0800 /* b11: Attach sense interrupt */ | ||
316 | #define EOFERR 0x0040 /* b6: EOF-error interrupt */ | ||
317 | #define SIGN 0x0020 /* b5: Setup ignore interrupt */ | ||
318 | #define SACK 0x0010 /* b4: Setup acknowledge interrupt */ | ||
319 | |||
320 | /* Frame Number Register */ | ||
321 | #define OVRN 0x8000 /* b15: Overrun error */ | ||
322 | #define CRCE 0x4000 /* b14: Received data error */ | ||
323 | #define FRNM 0x07FF /* b10-0: Frame number */ | ||
324 | |||
325 | /* Micro Frame Number Register */ | ||
326 | #define UFRNM 0x0007 /* b2-0: Micro frame number */ | ||
327 | |||
328 | /* Default Control Pipe Maxpacket Size Register */ | ||
329 | /* Pipe Maxpacket Size Register */ | ||
330 | #define DEVSEL 0xF000 /* b15-14: Device address select */ | ||
331 | #define MAXP 0x007F /* b6-0: Maxpacket size of default control pipe */ | ||
332 | |||
333 | /* Default Control Pipe Control Register */ | ||
334 | #define BSTS 0x8000 /* b15: Buffer status */ | ||
335 | #define SUREQ 0x4000 /* b14: Send USB request */ | ||
336 | #define CSCLR 0x2000 /* b13: complete-split status clear */ | ||
337 | #define CSSTS 0x1000 /* b12: complete-split status */ | ||
338 | #define SUREQCLR 0x0800 /* b11: stop setup request */ | ||
339 | #define SQCLR 0x0100 /* b8: Sequence toggle bit clear */ | ||
340 | #define SQSET 0x0080 /* b7: Sequence toggle bit set */ | ||
341 | #define SQMON 0x0040 /* b6: Sequence toggle bit monitor */ | ||
342 | #define PBUSY 0x0020 /* b5: pipe busy */ | ||
343 | #define PINGE 0x0010 /* b4: ping enable */ | ||
344 | #define CCPL 0x0004 /* b2: Enable control transfer complete */ | ||
345 | #define PID 0x0003 /* b1-0: Response PID */ | ||
346 | #define PID_STALL11 0x0003 /* STALL */ | ||
347 | #define PID_STALL 0x0002 /* STALL */ | ||
348 | #define PID_BUF 0x0001 /* BUF */ | ||
349 | #define PID_NAK 0x0000 /* NAK */ | ||
350 | |||
351 | /* Pipe Window Select Register */ | ||
352 | #define PIPENM 0x0007 /* b2-0: Pipe select */ | ||
353 | |||
354 | /* Pipe Configuration Register */ | ||
355 | #define R8A66597_TYP 0xC000 /* b15-14: Transfer type */ | ||
356 | #define R8A66597_ISO 0xC000 /* Isochronous */ | ||
357 | #define R8A66597_INT 0x8000 /* Interrupt */ | ||
358 | #define R8A66597_BULK 0x4000 /* Bulk */ | ||
359 | #define R8A66597_BFRE 0x0400 /* b10: Buffer ready interrupt mode select */ | ||
360 | #define R8A66597_DBLB 0x0200 /* b9: Double buffer mode select */ | ||
361 | #define R8A66597_CNTMD 0x0100 /* b8: Continuous transfer mode select */ | ||
362 | #define R8A66597_SHTNAK 0x0080 /* b7: Transfer end NAK */ | ||
363 | #define R8A66597_DIR 0x0010 /* b4: Transfer direction select */ | ||
364 | #define R8A66597_EPNUM 0x000F /* b3-0: Eendpoint number select */ | ||
365 | |||
366 | /* Pipe Buffer Configuration Register */ | ||
367 | #define BUFSIZE 0x7C00 /* b14-10: Pipe buffer size */ | ||
368 | #define BUFNMB 0x007F /* b6-0: Pipe buffer number */ | ||
369 | #define PIPE0BUF 256 | ||
370 | #define PIPExBUF 64 | ||
371 | |||
372 | /* Pipe Maxpacket Size Register */ | ||
373 | #define MXPS 0x07FF /* b10-0: Maxpacket size */ | ||
374 | |||
375 | /* Pipe Cycle Configuration Register */ | ||
376 | #define IFIS 0x1000 /* b12: Isochronous in-buffer flush mode select */ | ||
377 | #define IITV 0x0007 /* b2-0: Isochronous interval */ | ||
378 | |||
379 | /* Pipex Control Register */ | ||
380 | #define BSTS 0x8000 /* b15: Buffer status */ | ||
381 | #define INBUFM 0x4000 /* b14: IN buffer monitor (Only for PIPE1 to 5) */ | ||
382 | #define CSCLR 0x2000 /* b13: complete-split status clear */ | ||
383 | #define CSSTS 0x1000 /* b12: complete-split status */ | ||
384 | #define ATREPM 0x0400 /* b10: Auto repeat mode */ | ||
385 | #define ACLRM 0x0200 /* b9: Out buffer auto clear mode */ | ||
386 | #define SQCLR 0x0100 /* b8: Sequence toggle bit clear */ | ||
387 | #define SQSET 0x0080 /* b7: Sequence toggle bit set */ | ||
388 | #define SQMON 0x0040 /* b6: Sequence toggle bit monitor */ | ||
389 | #define PBUSY 0x0020 /* b5: pipe busy */ | ||
390 | #define PID 0x0003 /* b1-0: Response PID */ | ||
391 | |||
392 | /* PIPExTRE */ | ||
393 | #define TRENB 0x0200 /* b9: Transaction counter enable */ | ||
394 | #define TRCLR 0x0100 /* b8: Transaction counter clear */ | ||
395 | |||
396 | /* PIPExTRN */ | ||
397 | #define TRNCNT 0xFFFF /* b15-0: Transaction counter */ | ||
398 | |||
399 | /* DEVADDx */ | ||
400 | #define UPPHUB 0x7800 | ||
401 | #define HUBPORT 0x0700 | ||
402 | #define USBSPD 0x00C0 | ||
403 | #define RTPORT 0x0001 | ||
404 | |||
405 | #define R8A66597_MAX_NUM_PIPE 10 | 35 | #define R8A66597_MAX_NUM_PIPE 10 |
406 | #define R8A66597_BUF_BSIZE 8 | 36 | #define R8A66597_BUF_BSIZE 8 |
407 | #define R8A66597_MAX_DEVICE 10 | 37 | #define R8A66597_MAX_DEVICE 10 |
408 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | ||
409 | #define R8A66597_MAX_ROOT_HUB 1 | ||
410 | #else | ||
411 | #define R8A66597_MAX_ROOT_HUB 2 | 38 | #define R8A66597_MAX_ROOT_HUB 2 |
412 | #endif | ||
413 | #define R8A66597_MAX_SAMPLING 5 | 39 | #define R8A66597_MAX_SAMPLING 5 |
414 | #define R8A66597_RH_POLL_TIME 10 | 40 | #define R8A66597_RH_POLL_TIME 10 |
415 | #define R8A66597_MAX_DMA_CHANNEL 2 | 41 | #define R8A66597_MAX_DMA_CHANNEL 2 |
@@ -487,7 +113,7 @@ struct r8a66597_root_hub { | |||
487 | struct r8a66597 { | 113 | struct r8a66597 { |
488 | spinlock_t lock; | 114 | spinlock_t lock; |
489 | unsigned long reg; | 115 | unsigned long reg; |
490 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) && defined(CONFIG_HAVE_CLK) | 116 | #ifdef CONFIG_HAVE_CLK |
491 | struct clk *clk; | 117 | struct clk *clk; |
492 | #endif | 118 | #endif |
493 | struct r8a66597_platdata *pdata; | 119 | struct r8a66597_platdata *pdata; |
@@ -504,6 +130,7 @@ struct r8a66597 { | |||
504 | unsigned short interval_map; | 130 | unsigned short interval_map; |
505 | unsigned char pipe_cnt[R8A66597_MAX_NUM_PIPE]; | 131 | unsigned char pipe_cnt[R8A66597_MAX_NUM_PIPE]; |
506 | unsigned char dma_map; | 132 | unsigned char dma_map; |
133 | unsigned int max_root_hub; | ||
507 | 134 | ||
508 | struct list_head child_device; | 135 | struct list_head child_device; |
509 | unsigned long child_connect_map[4]; | 136 | unsigned long child_connect_map[4]; |
@@ -550,21 +177,22 @@ static inline void r8a66597_read_fifo(struct r8a66597 *r8a66597, | |||
550 | unsigned long offset, u16 *buf, | 177 | unsigned long offset, u16 *buf, |
551 | int len) | 178 | int len) |
552 | { | 179 | { |
553 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | ||
554 | unsigned long fifoaddr = r8a66597->reg + offset; | 180 | unsigned long fifoaddr = r8a66597->reg + offset; |
555 | unsigned long count; | 181 | unsigned long count; |
556 | 182 | ||
557 | count = len / 4; | 183 | if (r8a66597->pdata->on_chip) { |
558 | insl(fifoaddr, buf, count); | 184 | count = len / 4; |
185 | insl(fifoaddr, buf, count); | ||
559 | 186 | ||
560 | if (len & 0x00000003) { | 187 | if (len & 0x00000003) { |
561 | unsigned long tmp = inl(fifoaddr); | 188 | unsigned long tmp = inl(fifoaddr); |
562 | memcpy((unsigned char *)buf + count * 4, &tmp, len & 0x03); | 189 | memcpy((unsigned char *)buf + count * 4, &tmp, |
190 | len & 0x03); | ||
191 | } | ||
192 | } else { | ||
193 | len = (len + 1) / 2; | ||
194 | insw(fifoaddr, buf, len); | ||
563 | } | 195 | } |
564 | #else | ||
565 | len = (len + 1) / 2; | ||
566 | insw(r8a66597->reg + offset, buf, len); | ||
567 | #endif | ||
568 | } | 196 | } |
569 | 197 | ||
570 | static inline void r8a66597_write(struct r8a66597 *r8a66597, u16 val, | 198 | static inline void r8a66597_write(struct r8a66597 *r8a66597, u16 val, |
@@ -578,33 +206,33 @@ static inline void r8a66597_write_fifo(struct r8a66597 *r8a66597, | |||
578 | int len) | 206 | int len) |
579 | { | 207 | { |
580 | unsigned long fifoaddr = r8a66597->reg + offset; | 208 | unsigned long fifoaddr = r8a66597->reg + offset; |
581 | #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) | ||
582 | unsigned long count; | 209 | unsigned long count; |
583 | unsigned char *pb; | 210 | unsigned char *pb; |
584 | int i; | 211 | int i; |
585 | 212 | ||
586 | count = len / 4; | 213 | if (r8a66597->pdata->on_chip) { |
587 | outsl(fifoaddr, buf, count); | 214 | count = len / 4; |
215 | outsl(fifoaddr, buf, count); | ||
216 | |||
217 | if (len & 0x00000003) { | ||
218 | pb = (unsigned char *)buf + count * 4; | ||
219 | for (i = 0; i < (len & 0x00000003); i++) { | ||
220 | if (r8a66597_read(r8a66597, CFIFOSEL) & BIGEND) | ||
221 | outb(pb[i], fifoaddr + i); | ||
222 | else | ||
223 | outb(pb[i], fifoaddr + 3 - i); | ||
224 | } | ||
225 | } | ||
226 | } else { | ||
227 | int odd = len & 0x0001; | ||
588 | 228 | ||
589 | if (len & 0x00000003) { | 229 | len = len / 2; |
590 | pb = (unsigned char *)buf + count * 4; | 230 | outsw(fifoaddr, buf, len); |
591 | for (i = 0; i < (len & 0x00000003); i++) { | 231 | if (unlikely(odd)) { |
592 | if (r8a66597_read(r8a66597, CFIFOSEL) & BIGEND) | 232 | buf = &buf[len]; |
593 | outb(pb[i], fifoaddr + i); | 233 | outb((unsigned char)*buf, fifoaddr); |
594 | else | ||
595 | outb(pb[i], fifoaddr + 3 - i); | ||
596 | } | 234 | } |
597 | } | 235 | } |
598 | #else | ||
599 | int odd = len & 0x0001; | ||
600 | |||
601 | len = len / 2; | ||
602 | outsw(fifoaddr, buf, len); | ||
603 | if (unlikely(odd)) { | ||
604 | buf = &buf[len]; | ||
605 | outb((unsigned char)*buf, fifoaddr); | ||
606 | } | ||
607 | #endif | ||
608 | } | 236 | } |
609 | 237 | ||
610 | static inline void r8a66597_mdfy(struct r8a66597 *r8a66597, | 238 | static inline void r8a66597_mdfy(struct r8a66597 *r8a66597, |
diff --git a/drivers/usb/misc/iowarrior.c b/drivers/usb/misc/iowarrior.c index 90e1a8dedfa9..e75bb87ee92b 100644 --- a/drivers/usb/misc/iowarrior.c +++ b/drivers/usb/misc/iowarrior.c | |||
@@ -727,7 +727,7 @@ static const struct file_operations iowarrior_fops = { | |||
727 | .poll = iowarrior_poll, | 727 | .poll = iowarrior_poll, |
728 | }; | 728 | }; |
729 | 729 | ||
730 | static char *iowarrior_nodename(struct device *dev) | 730 | static char *iowarrior_devnode(struct device *dev, mode_t *mode) |
731 | { | 731 | { |
732 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); | 732 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); |
733 | } | 733 | } |
@@ -738,7 +738,7 @@ static char *iowarrior_nodename(struct device *dev) | |||
738 | */ | 738 | */ |
739 | static struct usb_class_driver iowarrior_class = { | 739 | static struct usb_class_driver iowarrior_class = { |
740 | .name = "iowarrior%d", | 740 | .name = "iowarrior%d", |
741 | .nodename = iowarrior_nodename, | 741 | .devnode = iowarrior_devnode, |
742 | .fops = &iowarrior_fops, | 742 | .fops = &iowarrior_fops, |
743 | .minor_base = IOWARRIOR_MINOR_BASE, | 743 | .minor_base = IOWARRIOR_MINOR_BASE, |
744 | }; | 744 | }; |
diff --git a/drivers/usb/misc/legousbtower.c b/drivers/usb/misc/legousbtower.c index c1e2433f640d..97efeaec4d52 100644 --- a/drivers/usb/misc/legousbtower.c +++ b/drivers/usb/misc/legousbtower.c | |||
@@ -266,7 +266,7 @@ static const struct file_operations tower_fops = { | |||
266 | .llseek = tower_llseek, | 266 | .llseek = tower_llseek, |
267 | }; | 267 | }; |
268 | 268 | ||
269 | static char *legousbtower_nodename(struct device *dev) | 269 | static char *legousbtower_devnode(struct device *dev, mode_t *mode) |
270 | { | 270 | { |
271 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); | 271 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); |
272 | } | 272 | } |
@@ -277,7 +277,7 @@ static char *legousbtower_nodename(struct device *dev) | |||
277 | */ | 277 | */ |
278 | static struct usb_class_driver tower_class = { | 278 | static struct usb_class_driver tower_class = { |
279 | .name = "legousbtower%d", | 279 | .name = "legousbtower%d", |
280 | .nodename = legousbtower_nodename, | 280 | .devnode = legousbtower_devnode, |
281 | .fops = &tower_fops, | 281 | .fops = &tower_fops, |
282 | .minor_base = LEGO_USB_TOWER_MINOR_BASE, | 282 | .minor_base = LEGO_USB_TOWER_MINOR_BASE, |
283 | }; | 283 | }; |
diff --git a/drivers/usb/serial/ark3116.c b/drivers/usb/serial/ark3116.c index aec61880f36c..5d25d3e52bf6 100644 --- a/drivers/usb/serial/ark3116.c +++ b/drivers/usb/serial/ark3116.c | |||
@@ -35,11 +35,6 @@ static struct usb_device_id id_table [] = { | |||
35 | }; | 35 | }; |
36 | MODULE_DEVICE_TABLE(usb, id_table); | 36 | MODULE_DEVICE_TABLE(usb, id_table); |
37 | 37 | ||
38 | struct ark3116_private { | ||
39 | spinlock_t lock; | ||
40 | u8 termios_initialized; | ||
41 | }; | ||
42 | |||
43 | static inline void ARK3116_SND(struct usb_serial *serial, int seq, | 38 | static inline void ARK3116_SND(struct usb_serial *serial, int seq, |
44 | __u8 request, __u8 requesttype, | 39 | __u8 request, __u8 requesttype, |
45 | __u16 value, __u16 index) | 40 | __u16 value, __u16 index) |
@@ -82,22 +77,11 @@ static inline void ARK3116_RCV_QUIET(struct usb_serial *serial, | |||
82 | static int ark3116_attach(struct usb_serial *serial) | 77 | static int ark3116_attach(struct usb_serial *serial) |
83 | { | 78 | { |
84 | char *buf; | 79 | char *buf; |
85 | struct ark3116_private *priv; | ||
86 | int i; | ||
87 | |||
88 | for (i = 0; i < serial->num_ports; ++i) { | ||
89 | priv = kzalloc(sizeof(struct ark3116_private), GFP_KERNEL); | ||
90 | if (!priv) | ||
91 | goto cleanup; | ||
92 | spin_lock_init(&priv->lock); | ||
93 | |||
94 | usb_set_serial_port_data(serial->port[i], priv); | ||
95 | } | ||
96 | 80 | ||
97 | buf = kmalloc(1, GFP_KERNEL); | 81 | buf = kmalloc(1, GFP_KERNEL); |
98 | if (!buf) { | 82 | if (!buf) { |
99 | dbg("error kmalloc -> out of mem?"); | 83 | dbg("error kmalloc -> out of mem?"); |
100 | goto cleanup; | 84 | return -ENOMEM; |
101 | } | 85 | } |
102 | 86 | ||
103 | /* 3 */ | 87 | /* 3 */ |
@@ -149,13 +133,16 @@ static int ark3116_attach(struct usb_serial *serial) | |||
149 | 133 | ||
150 | kfree(buf); | 134 | kfree(buf); |
151 | return 0; | 135 | return 0; |
136 | } | ||
152 | 137 | ||
153 | cleanup: | 138 | static void ark3116_init_termios(struct tty_struct *tty) |
154 | for (--i; i >= 0; --i) { | 139 | { |
155 | kfree(usb_get_serial_port_data(serial->port[i])); | 140 | struct ktermios *termios = tty->termios; |
156 | usb_set_serial_port_data(serial->port[i], NULL); | 141 | *termios = tty_std_termios; |
157 | } | 142 | termios->c_cflag = B9600 | CS8 |
158 | return -ENOMEM; | 143 | | CREAD | HUPCL | CLOCAL; |
144 | termios->c_ispeed = 9600; | ||
145 | termios->c_ospeed = 9600; | ||
159 | } | 146 | } |
160 | 147 | ||
161 | static void ark3116_set_termios(struct tty_struct *tty, | 148 | static void ark3116_set_termios(struct tty_struct *tty, |
@@ -163,10 +150,8 @@ static void ark3116_set_termios(struct tty_struct *tty, | |||
163 | struct ktermios *old_termios) | 150 | struct ktermios *old_termios) |
164 | { | 151 | { |
165 | struct usb_serial *serial = port->serial; | 152 | struct usb_serial *serial = port->serial; |
166 | struct ark3116_private *priv = usb_get_serial_port_data(port); | ||
167 | struct ktermios *termios = tty->termios; | 153 | struct ktermios *termios = tty->termios; |
168 | unsigned int cflag = termios->c_cflag; | 154 | unsigned int cflag = termios->c_cflag; |
169 | unsigned long flags; | ||
170 | int baud; | 155 | int baud; |
171 | int ark3116_baud; | 156 | int ark3116_baud; |
172 | char *buf; | 157 | char *buf; |
@@ -176,16 +161,6 @@ static void ark3116_set_termios(struct tty_struct *tty, | |||
176 | 161 | ||
177 | dbg("%s - port %d", __func__, port->number); | 162 | dbg("%s - port %d", __func__, port->number); |
178 | 163 | ||
179 | spin_lock_irqsave(&priv->lock, flags); | ||
180 | if (!priv->termios_initialized) { | ||
181 | *termios = tty_std_termios; | ||
182 | termios->c_cflag = B9600 | CS8 | ||
183 | | CREAD | HUPCL | CLOCAL; | ||
184 | termios->c_ispeed = 9600; | ||
185 | termios->c_ospeed = 9600; | ||
186 | priv->termios_initialized = 1; | ||
187 | } | ||
188 | spin_unlock_irqrestore(&priv->lock, flags); | ||
189 | 164 | ||
190 | cflag = termios->c_cflag; | 165 | cflag = termios->c_cflag; |
191 | termios->c_cflag &= ~(CMSPAR|CRTSCTS); | 166 | termios->c_cflag &= ~(CMSPAR|CRTSCTS); |
@@ -318,8 +293,7 @@ static void ark3116_set_termios(struct tty_struct *tty, | |||
318 | return; | 293 | return; |
319 | } | 294 | } |
320 | 295 | ||
321 | static int ark3116_open(struct tty_struct *tty, struct usb_serial_port *port, | 296 | static int ark3116_open(struct tty_struct *tty, struct usb_serial_port *port) |
322 | struct file *filp) | ||
323 | { | 297 | { |
324 | struct ktermios tmp_termios; | 298 | struct ktermios tmp_termios; |
325 | struct usb_serial *serial = port->serial; | 299 | struct usb_serial *serial = port->serial; |
@@ -334,7 +308,7 @@ static int ark3116_open(struct tty_struct *tty, struct usb_serial_port *port, | |||
334 | return -ENOMEM; | 308 | return -ENOMEM; |
335 | } | 309 | } |
336 | 310 | ||
337 | result = usb_serial_generic_open(tty, port, filp); | 311 | result = usb_serial_generic_open(tty, port); |
338 | if (result) | 312 | if (result) |
339 | goto err_out; | 313 | goto err_out; |
340 | 314 | ||
@@ -455,6 +429,7 @@ static struct usb_serial_driver ark3116_device = { | |||
455 | .num_ports = 1, | 429 | .num_ports = 1, |
456 | .attach = ark3116_attach, | 430 | .attach = ark3116_attach, |
457 | .set_termios = ark3116_set_termios, | 431 | .set_termios = ark3116_set_termios, |
432 | .init_termios = ark3116_init_termios, | ||
458 | .ioctl = ark3116_ioctl, | 433 | .ioctl = ark3116_ioctl, |
459 | .tiocmget = ark3116_tiocmget, | 434 | .tiocmget = ark3116_tiocmget, |
460 | .open = ark3116_open, | 435 | .open = ark3116_open, |
diff --git a/drivers/usb/serial/belkin_sa.c b/drivers/usb/serial/belkin_sa.c index 7033b031b443..a0467bc61627 100644 --- a/drivers/usb/serial/belkin_sa.c +++ b/drivers/usb/serial/belkin_sa.c | |||
@@ -92,7 +92,7 @@ static int debug; | |||
92 | static int belkin_sa_startup(struct usb_serial *serial); | 92 | static int belkin_sa_startup(struct usb_serial *serial); |
93 | static void belkin_sa_release(struct usb_serial *serial); | 93 | static void belkin_sa_release(struct usb_serial *serial); |
94 | static int belkin_sa_open(struct tty_struct *tty, | 94 | static int belkin_sa_open(struct tty_struct *tty, |
95 | struct usb_serial_port *port, struct file *filp); | 95 | struct usb_serial_port *port); |
96 | static void belkin_sa_close(struct usb_serial_port *port); | 96 | static void belkin_sa_close(struct usb_serial_port *port); |
97 | static void belkin_sa_read_int_callback(struct urb *urb); | 97 | static void belkin_sa_read_int_callback(struct urb *urb); |
98 | static void belkin_sa_set_termios(struct tty_struct *tty, | 98 | static void belkin_sa_set_termios(struct tty_struct *tty, |
@@ -213,7 +213,7 @@ static void belkin_sa_release(struct usb_serial *serial) | |||
213 | 213 | ||
214 | 214 | ||
215 | static int belkin_sa_open(struct tty_struct *tty, | 215 | static int belkin_sa_open(struct tty_struct *tty, |
216 | struct usb_serial_port *port, struct file *filp) | 216 | struct usb_serial_port *port) |
217 | { | 217 | { |
218 | int retval = 0; | 218 | int retval = 0; |
219 | 219 | ||
diff --git a/drivers/usb/serial/ch341.c b/drivers/usb/serial/ch341.c index 2830766f5b39..8c894a7d5dcf 100644 --- a/drivers/usb/serial/ch341.c +++ b/drivers/usb/serial/ch341.c | |||
@@ -300,8 +300,7 @@ static void ch341_close(struct usb_serial_port *port) | |||
300 | 300 | ||
301 | 301 | ||
302 | /* open this device, set default parameters */ | 302 | /* open this device, set default parameters */ |
303 | static int ch341_open(struct tty_struct *tty, struct usb_serial_port *port, | 303 | static int ch341_open(struct tty_struct *tty, struct usb_serial_port *port) |
304 | struct file *filp) | ||
305 | { | 304 | { |
306 | struct usb_serial *serial = port->serial; | 305 | struct usb_serial *serial = port->serial; |
307 | struct ch341_private *priv = usb_get_serial_port_data(serial->port[0]); | 306 | struct ch341_private *priv = usb_get_serial_port_data(serial->port[0]); |
@@ -333,7 +332,7 @@ static int ch341_open(struct tty_struct *tty, struct usb_serial_port *port, | |||
333 | return -EPROTO; | 332 | return -EPROTO; |
334 | } | 333 | } |
335 | 334 | ||
336 | r = usb_serial_generic_open(tty, port, filp); | 335 | r = usb_serial_generic_open(tty, port); |
337 | 336 | ||
338 | out: return r; | 337 | out: return r; |
339 | } | 338 | } |
diff --git a/drivers/usb/serial/console.c b/drivers/usb/serial/console.c index 0e4f2e41ace5..b22ac3258523 100644 --- a/drivers/usb/serial/console.c +++ b/drivers/usb/serial/console.c | |||
@@ -16,6 +16,7 @@ | |||
16 | #include <linux/slab.h> | 16 | #include <linux/slab.h> |
17 | #include <linux/tty.h> | 17 | #include <linux/tty.h> |
18 | #include <linux/console.h> | 18 | #include <linux/console.h> |
19 | #include <linux/serial.h> | ||
19 | #include <linux/usb.h> | 20 | #include <linux/usb.h> |
20 | #include <linux/usb/serial.h> | 21 | #include <linux/usb/serial.h> |
21 | 22 | ||
@@ -63,7 +64,7 @@ static int usb_console_setup(struct console *co, char *options) | |||
63 | char *s; | 64 | char *s; |
64 | struct usb_serial *serial; | 65 | struct usb_serial *serial; |
65 | struct usb_serial_port *port; | 66 | struct usb_serial_port *port; |
66 | int retval = 0; | 67 | int retval; |
67 | struct tty_struct *tty = NULL; | 68 | struct tty_struct *tty = NULL; |
68 | struct ktermios *termios = NULL, dummy; | 69 | struct ktermios *termios = NULL, dummy; |
69 | 70 | ||
@@ -116,13 +117,17 @@ static int usb_console_setup(struct console *co, char *options) | |||
116 | return -ENODEV; | 117 | return -ENODEV; |
117 | } | 118 | } |
118 | 119 | ||
119 | port = serial->port[0]; | 120 | retval = usb_autopm_get_interface(serial->interface); |
121 | if (retval) | ||
122 | goto error_get_interface; | ||
123 | |||
124 | port = serial->port[co->index - serial->minor]; | ||
120 | tty_port_tty_set(&port->port, NULL); | 125 | tty_port_tty_set(&port->port, NULL); |
121 | 126 | ||
122 | info->port = port; | 127 | info->port = port; |
123 | 128 | ||
124 | ++port->port.count; | 129 | ++port->port.count; |
125 | if (port->port.count == 1) { | 130 | if (!test_bit(ASYNCB_INITIALIZED, &port->port.flags)) { |
126 | if (serial->type->set_termios) { | 131 | if (serial->type->set_termios) { |
127 | /* | 132 | /* |
128 | * allocate a fake tty so the driver can initialize | 133 | * allocate a fake tty so the driver can initialize |
@@ -150,9 +155,9 @@ static int usb_console_setup(struct console *co, char *options) | |||
150 | /* only call the device specific open if this | 155 | /* only call the device specific open if this |
151 | * is the first time the port is opened */ | 156 | * is the first time the port is opened */ |
152 | if (serial->type->open) | 157 | if (serial->type->open) |
153 | retval = serial->type->open(NULL, port, NULL); | 158 | retval = serial->type->open(NULL, port); |
154 | else | 159 | else |
155 | retval = usb_serial_generic_open(NULL, port, NULL); | 160 | retval = usb_serial_generic_open(NULL, port); |
156 | 161 | ||
157 | if (retval) { | 162 | if (retval) { |
158 | err("could not open USB console port"); | 163 | err("could not open USB console port"); |
@@ -168,6 +173,7 @@ static int usb_console_setup(struct console *co, char *options) | |||
168 | kfree(termios); | 173 | kfree(termios); |
169 | kfree(tty); | 174 | kfree(tty); |
170 | } | 175 | } |
176 | set_bit(ASYNCB_INITIALIZED, &port->port.flags); | ||
171 | } | 177 | } |
172 | /* Now that any required fake tty operations are completed restore | 178 | /* Now that any required fake tty operations are completed restore |
173 | * the tty port count */ | 179 | * the tty port count */ |
@@ -175,18 +181,22 @@ static int usb_console_setup(struct console *co, char *options) | |||
175 | /* The console is special in terms of closing the device so | 181 | /* The console is special in terms of closing the device so |
176 | * indicate this port is now acting as a system console. */ | 182 | * indicate this port is now acting as a system console. */ |
177 | port->console = 1; | 183 | port->console = 1; |
178 | retval = 0; | ||
179 | 184 | ||
180 | out: | 185 | mutex_unlock(&serial->disc_mutex); |
181 | return retval; | 186 | return retval; |
182 | free_termios: | 187 | |
188 | free_termios: | ||
183 | kfree(termios); | 189 | kfree(termios); |
184 | tty_port_tty_set(&port->port, NULL); | 190 | tty_port_tty_set(&port->port, NULL); |
185 | free_tty: | 191 | free_tty: |
186 | kfree(tty); | 192 | kfree(tty); |
187 | reset_open_count: | 193 | reset_open_count: |
188 | port->port.count = 0; | 194 | port->port.count = 0; |
189 | goto out; | 195 | usb_autopm_put_interface(serial->interface); |
196 | error_get_interface: | ||
197 | usb_serial_put(serial); | ||
198 | mutex_unlock(&serial->disc_mutex); | ||
199 | return retval; | ||
190 | } | 200 | } |
191 | 201 | ||
192 | static void usb_console_write(struct console *co, | 202 | static void usb_console_write(struct console *co, |
diff --git a/drivers/usb/serial/cp210x.c b/drivers/usb/serial/cp210x.c index 985cbcf48bda..4a208fe85bc9 100644 --- a/drivers/usb/serial/cp210x.c +++ b/drivers/usb/serial/cp210x.c | |||
@@ -33,8 +33,7 @@ | |||
33 | /* | 33 | /* |
34 | * Function Prototypes | 34 | * Function Prototypes |
35 | */ | 35 | */ |
36 | static int cp210x_open(struct tty_struct *, struct usb_serial_port *, | 36 | static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *); |
37 | struct file *); | ||
38 | static void cp210x_cleanup(struct usb_serial_port *); | 37 | static void cp210x_cleanup(struct usb_serial_port *); |
39 | static void cp210x_close(struct usb_serial_port *); | 38 | static void cp210x_close(struct usb_serial_port *); |
40 | static void cp210x_get_termios(struct tty_struct *, | 39 | static void cp210x_get_termios(struct tty_struct *, |
@@ -368,8 +367,7 @@ static unsigned int cp210x_quantise_baudrate(unsigned int baud) { | |||
368 | return baud; | 367 | return baud; |
369 | } | 368 | } |
370 | 369 | ||
371 | static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *port, | 370 | static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *port) |
372 | struct file *filp) | ||
373 | { | 371 | { |
374 | struct usb_serial *serial = port->serial; | 372 | struct usb_serial *serial = port->serial; |
375 | int result; | 373 | int result; |
@@ -399,12 +397,6 @@ static int cp210x_open(struct tty_struct *tty, struct usb_serial_port *port, | |||
399 | 397 | ||
400 | /* Configure the termios structure */ | 398 | /* Configure the termios structure */ |
401 | cp210x_get_termios(tty, port); | 399 | cp210x_get_termios(tty, port); |
402 | |||
403 | /* Set the DTR and RTS pins low */ | ||
404 | cp210x_tiocmset_port(tty ? (struct usb_serial_port *) tty->driver_data | ||
405 | : port, | ||
406 | NULL, TIOCM_DTR | TIOCM_RTS, 0); | ||
407 | |||
408 | return 0; | 400 | return 0; |
409 | } | 401 | } |
410 | 402 | ||
diff --git a/drivers/usb/serial/cyberjack.c b/drivers/usb/serial/cyberjack.c index 336523fd7366..b0f6402a91ca 100644 --- a/drivers/usb/serial/cyberjack.c +++ b/drivers/usb/serial/cyberjack.c | |||
@@ -61,7 +61,7 @@ static int cyberjack_startup(struct usb_serial *serial); | |||
61 | static void cyberjack_disconnect(struct usb_serial *serial); | 61 | static void cyberjack_disconnect(struct usb_serial *serial); |
62 | static void cyberjack_release(struct usb_serial *serial); | 62 | static void cyberjack_release(struct usb_serial *serial); |
63 | static int cyberjack_open(struct tty_struct *tty, | 63 | static int cyberjack_open(struct tty_struct *tty, |
64 | struct usb_serial_port *port, struct file *filp); | 64 | struct usb_serial_port *port); |
65 | static void cyberjack_close(struct usb_serial_port *port); | 65 | static void cyberjack_close(struct usb_serial_port *port); |
66 | static int cyberjack_write(struct tty_struct *tty, | 66 | static int cyberjack_write(struct tty_struct *tty, |
67 | struct usb_serial_port *port, const unsigned char *buf, int count); | 67 | struct usb_serial_port *port, const unsigned char *buf, int count); |
@@ -173,7 +173,7 @@ static void cyberjack_release(struct usb_serial *serial) | |||
173 | } | 173 | } |
174 | 174 | ||
175 | static int cyberjack_open(struct tty_struct *tty, | 175 | static int cyberjack_open(struct tty_struct *tty, |
176 | struct usb_serial_port *port, struct file *filp) | 176 | struct usb_serial_port *port) |
177 | { | 177 | { |
178 | struct cyberjack_private *priv; | 178 | struct cyberjack_private *priv; |
179 | unsigned long flags; | 179 | unsigned long flags; |
diff --git a/drivers/usb/serial/cypress_m8.c b/drivers/usb/serial/cypress_m8.c index 59adfe123110..e0a8b715f2f2 100644 --- a/drivers/usb/serial/cypress_m8.c +++ b/drivers/usb/serial/cypress_m8.c | |||
@@ -172,8 +172,7 @@ static int cypress_earthmate_startup(struct usb_serial *serial); | |||
172 | static int cypress_hidcom_startup(struct usb_serial *serial); | 172 | static int cypress_hidcom_startup(struct usb_serial *serial); |
173 | static int cypress_ca42v2_startup(struct usb_serial *serial); | 173 | static int cypress_ca42v2_startup(struct usb_serial *serial); |
174 | static void cypress_release(struct usb_serial *serial); | 174 | static void cypress_release(struct usb_serial *serial); |
175 | static int cypress_open(struct tty_struct *tty, | 175 | static int cypress_open(struct tty_struct *tty, struct usb_serial_port *port); |
176 | struct usb_serial_port *port, struct file *filp); | ||
177 | static void cypress_close(struct usb_serial_port *port); | 176 | static void cypress_close(struct usb_serial_port *port); |
178 | static void cypress_dtr_rts(struct usb_serial_port *port, int on); | 177 | static void cypress_dtr_rts(struct usb_serial_port *port, int on); |
179 | static int cypress_write(struct tty_struct *tty, struct usb_serial_port *port, | 178 | static int cypress_write(struct tty_struct *tty, struct usb_serial_port *port, |
@@ -633,8 +632,7 @@ static void cypress_release(struct usb_serial *serial) | |||
633 | } | 632 | } |
634 | 633 | ||
635 | 634 | ||
636 | static int cypress_open(struct tty_struct *tty, | 635 | static int cypress_open(struct tty_struct *tty, struct usb_serial_port *port) |
637 | struct usb_serial_port *port, struct file *filp) | ||
638 | { | 636 | { |
639 | struct cypress_private *priv = usb_get_serial_port_data(port); | 637 | struct cypress_private *priv = usb_get_serial_port_data(port); |
640 | struct usb_serial *serial = port->serial; | 638 | struct usb_serial *serial = port->serial; |
@@ -659,15 +657,7 @@ static int cypress_open(struct tty_struct *tty, | |||
659 | spin_unlock_irqrestore(&priv->lock, flags); | 657 | spin_unlock_irqrestore(&priv->lock, flags); |
660 | 658 | ||
661 | /* Set termios */ | 659 | /* Set termios */ |
662 | result = cypress_write(tty, port, NULL, 0); | 660 | cypress_send(port); |
663 | |||
664 | if (result) { | ||
665 | dev_err(&port->dev, | ||
666 | "%s - failed setting the control lines - error %d\n", | ||
667 | __func__, result); | ||
668 | return result; | ||
669 | } else | ||
670 | dbg("%s - success setting the control lines", __func__); | ||
671 | 661 | ||
672 | if (tty) | 662 | if (tty) |
673 | cypress_set_termios(tty, port, &priv->tmp_termios); | 663 | cypress_set_termios(tty, port, &priv->tmp_termios); |
@@ -1005,6 +995,8 @@ static void cypress_set_termios(struct tty_struct *tty, | |||
1005 | dbg("%s - port %d", __func__, port->number); | 995 | dbg("%s - port %d", __func__, port->number); |
1006 | 996 | ||
1007 | spin_lock_irqsave(&priv->lock, flags); | 997 | spin_lock_irqsave(&priv->lock, flags); |
998 | /* We can't clean this one up as we don't know the device type | ||
999 | early enough */ | ||
1008 | if (!priv->termios_initialized) { | 1000 | if (!priv->termios_initialized) { |
1009 | if (priv->chiptype == CT_EARTHMATE) { | 1001 | if (priv->chiptype == CT_EARTHMATE) { |
1010 | *(tty->termios) = tty_std_termios; | 1002 | *(tty->termios) = tty_std_termios; |
diff --git a/drivers/usb/serial/digi_acceleport.c b/drivers/usb/serial/digi_acceleport.c index f4808091c47c..ab3dd991586b 100644 --- a/drivers/usb/serial/digi_acceleport.c +++ b/drivers/usb/serial/digi_acceleport.c | |||
@@ -453,8 +453,7 @@ static int digi_write(struct tty_struct *tty, struct usb_serial_port *port, | |||
453 | static void digi_write_bulk_callback(struct urb *urb); | 453 | static void digi_write_bulk_callback(struct urb *urb); |
454 | static int digi_write_room(struct tty_struct *tty); | 454 | static int digi_write_room(struct tty_struct *tty); |
455 | static int digi_chars_in_buffer(struct tty_struct *tty); | 455 | static int digi_chars_in_buffer(struct tty_struct *tty); |
456 | static int digi_open(struct tty_struct *tty, struct usb_serial_port *port, | 456 | static int digi_open(struct tty_struct *tty, struct usb_serial_port *port); |
457 | struct file *filp); | ||
458 | static void digi_close(struct usb_serial_port *port); | 457 | static void digi_close(struct usb_serial_port *port); |
459 | static int digi_carrier_raised(struct usb_serial_port *port); | 458 | static int digi_carrier_raised(struct usb_serial_port *port); |
460 | static void digi_dtr_rts(struct usb_serial_port *port, int on); | 459 | static void digi_dtr_rts(struct usb_serial_port *port, int on); |
@@ -1347,8 +1346,7 @@ static int digi_carrier_raised(struct usb_serial_port *port) | |||
1347 | return 0; | 1346 | return 0; |
1348 | } | 1347 | } |
1349 | 1348 | ||
1350 | static int digi_open(struct tty_struct *tty, struct usb_serial_port *port, | 1349 | static int digi_open(struct tty_struct *tty, struct usb_serial_port *port) |
1351 | struct file *filp) | ||
1352 | { | 1350 | { |
1353 | int ret; | 1351 | int ret; |
1354 | unsigned char buf[32]; | 1352 | unsigned char buf[32]; |
diff --git a/drivers/usb/serial/empeg.c b/drivers/usb/serial/empeg.c index 80cb3471adbe..33c9e9cf9eb2 100644 --- a/drivers/usb/serial/empeg.c +++ b/drivers/usb/serial/empeg.c | |||
@@ -79,8 +79,7 @@ static int debug; | |||
79 | #define EMPEG_PRODUCT_ID 0x0001 | 79 | #define EMPEG_PRODUCT_ID 0x0001 |
80 | 80 | ||
81 | /* function prototypes for an empeg-car player */ | 81 | /* function prototypes for an empeg-car player */ |
82 | static int empeg_open(struct tty_struct *tty, struct usb_serial_port *port, | 82 | static int empeg_open(struct tty_struct *tty, struct usb_serial_port *port); |
83 | struct file *filp); | ||
84 | static void empeg_close(struct usb_serial_port *port); | 83 | static void empeg_close(struct usb_serial_port *port); |
85 | static int empeg_write(struct tty_struct *tty, struct usb_serial_port *port, | 84 | static int empeg_write(struct tty_struct *tty, struct usb_serial_port *port, |
86 | const unsigned char *buf, | 85 | const unsigned char *buf, |
@@ -90,8 +89,7 @@ static int empeg_chars_in_buffer(struct tty_struct *tty); | |||
90 | static void empeg_throttle(struct tty_struct *tty); | 89 | static void empeg_throttle(struct tty_struct *tty); |
91 | static void empeg_unthrottle(struct tty_struct *tty); | 90 | static void empeg_unthrottle(struct tty_struct *tty); |
92 | static int empeg_startup(struct usb_serial *serial); | 91 | static int empeg_startup(struct usb_serial *serial); |
93 | static void empeg_set_termios(struct tty_struct *tty, | 92 | static void empeg_init_termios(struct tty_struct *tty); |
94 | struct usb_serial_port *port, struct ktermios *old_termios); | ||
95 | static void empeg_write_bulk_callback(struct urb *urb); | 93 | static void empeg_write_bulk_callback(struct urb *urb); |
96 | static void empeg_read_bulk_callback(struct urb *urb); | 94 | static void empeg_read_bulk_callback(struct urb *urb); |
97 | 95 | ||
@@ -123,7 +121,7 @@ static struct usb_serial_driver empeg_device = { | |||
123 | .throttle = empeg_throttle, | 121 | .throttle = empeg_throttle, |
124 | .unthrottle = empeg_unthrottle, | 122 | .unthrottle = empeg_unthrottle, |
125 | .attach = empeg_startup, | 123 | .attach = empeg_startup, |
126 | .set_termios = empeg_set_termios, | 124 | .init_termios = empeg_init_termios, |
127 | .write = empeg_write, | 125 | .write = empeg_write, |
128 | .write_room = empeg_write_room, | 126 | .write_room = empeg_write_room, |
129 | .chars_in_buffer = empeg_chars_in_buffer, | 127 | .chars_in_buffer = empeg_chars_in_buffer, |
@@ -142,17 +140,13 @@ static int bytes_out; | |||
142 | /****************************************************************************** | 140 | /****************************************************************************** |
143 | * Empeg specific driver functions | 141 | * Empeg specific driver functions |
144 | ******************************************************************************/ | 142 | ******************************************************************************/ |
145 | static int empeg_open(struct tty_struct *tty, struct usb_serial_port *port, | 143 | static int empeg_open(struct tty_struct *tty,struct usb_serial_port *port) |
146 | struct file *filp) | ||
147 | { | 144 | { |
148 | struct usb_serial *serial = port->serial; | 145 | struct usb_serial *serial = port->serial; |
149 | int result = 0; | 146 | int result = 0; |
150 | 147 | ||
151 | dbg("%s - port %d", __func__, port->number); | 148 | dbg("%s - port %d", __func__, port->number); |
152 | 149 | ||
153 | /* Force default termio settings */ | ||
154 | empeg_set_termios(tty, port, NULL) ; | ||
155 | |||
156 | bytes_in = 0; | 150 | bytes_in = 0; |
157 | bytes_out = 0; | 151 | bytes_out = 0; |
158 | 152 | ||
@@ -425,11 +419,9 @@ static int empeg_startup(struct usb_serial *serial) | |||
425 | } | 419 | } |
426 | 420 | ||
427 | 421 | ||
428 | static void empeg_set_termios(struct tty_struct *tty, | 422 | static void empeg_init_termios(struct tty_struct *tty) |
429 | struct usb_serial_port *port, struct ktermios *old_termios) | ||
430 | { | 423 | { |
431 | struct ktermios *termios = tty->termios; | 424 | struct ktermios *termios = tty->termios; |
432 | dbg("%s - port %d", __func__, port->number); | ||
433 | 425 | ||
434 | /* | 426 | /* |
435 | * The empeg-car player wants these particular tty settings. | 427 | * The empeg-car player wants these particular tty settings. |
diff --git a/drivers/usb/serial/ftdi_sio.c b/drivers/usb/serial/ftdi_sio.c index 8fec5d4455c9..76a17f915eef 100644 --- a/drivers/usb/serial/ftdi_sio.c +++ b/drivers/usb/serial/ftdi_sio.c | |||
@@ -747,8 +747,7 @@ static int ftdi_sio_probe(struct usb_serial *serial, | |||
747 | const struct usb_device_id *id); | 747 | const struct usb_device_id *id); |
748 | static int ftdi_sio_port_probe(struct usb_serial_port *port); | 748 | static int ftdi_sio_port_probe(struct usb_serial_port *port); |
749 | static int ftdi_sio_port_remove(struct usb_serial_port *port); | 749 | static int ftdi_sio_port_remove(struct usb_serial_port *port); |
750 | static int ftdi_open(struct tty_struct *tty, | 750 | static int ftdi_open(struct tty_struct *tty, struct usb_serial_port *port); |
751 | struct usb_serial_port *port, struct file *filp); | ||
752 | static void ftdi_close(struct usb_serial_port *port); | 751 | static void ftdi_close(struct usb_serial_port *port); |
753 | static void ftdi_dtr_rts(struct usb_serial_port *port, int on); | 752 | static void ftdi_dtr_rts(struct usb_serial_port *port, int on); |
754 | static int ftdi_write(struct tty_struct *tty, struct usb_serial_port *port, | 753 | static int ftdi_write(struct tty_struct *tty, struct usb_serial_port *port, |
@@ -1680,8 +1679,7 @@ static int ftdi_sio_port_remove(struct usb_serial_port *port) | |||
1680 | return 0; | 1679 | return 0; |
1681 | } | 1680 | } |
1682 | 1681 | ||
1683 | static int ftdi_open(struct tty_struct *tty, | 1682 | static int ftdi_open(struct tty_struct *tty, struct usb_serial_port *port) |
1684 | struct usb_serial_port *port, struct file *filp) | ||
1685 | { /* ftdi_open */ | 1683 | { /* ftdi_open */ |
1686 | struct usb_device *dev = port->serial->dev; | 1684 | struct usb_device *dev = port->serial->dev; |
1687 | struct ftdi_private *priv = usb_get_serial_port_data(port); | 1685 | struct ftdi_private *priv = usb_get_serial_port_data(port); |
diff --git a/drivers/usb/serial/garmin_gps.c b/drivers/usb/serial/garmin_gps.c index 8839f1c70b7f..20432d345529 100644 --- a/drivers/usb/serial/garmin_gps.c +++ b/drivers/usb/serial/garmin_gps.c | |||
@@ -933,8 +933,7 @@ static int garmin_init_session(struct usb_serial_port *port) | |||
933 | 933 | ||
934 | 934 | ||
935 | 935 | ||
936 | static int garmin_open(struct tty_struct *tty, | 936 | static int garmin_open(struct tty_struct *tty, struct usb_serial_port *port) |
937 | struct usb_serial_port *port, struct file *filp) | ||
938 | { | 937 | { |
939 | unsigned long flags; | 938 | unsigned long flags; |
940 | int status = 0; | 939 | int status = 0; |
diff --git a/drivers/usb/serial/generic.c b/drivers/usb/serial/generic.c index ce57f6a32bdf..d9398e9f30ce 100644 --- a/drivers/usb/serial/generic.c +++ b/drivers/usb/serial/generic.c | |||
@@ -114,8 +114,7 @@ void usb_serial_generic_deregister(void) | |||
114 | #endif | 114 | #endif |
115 | } | 115 | } |
116 | 116 | ||
117 | int usb_serial_generic_open(struct tty_struct *tty, | 117 | int usb_serial_generic_open(struct tty_struct *tty, struct usb_serial_port *port) |
118 | struct usb_serial_port *port, struct file *filp) | ||
119 | { | 118 | { |
120 | struct usb_serial *serial = port->serial; | 119 | struct usb_serial *serial = port->serial; |
121 | int result = 0; | 120 | int result = 0; |
diff --git a/drivers/usb/serial/io_edgeport.c b/drivers/usb/serial/io_edgeport.c index 0191693625d6..dc0f832657e6 100644 --- a/drivers/usb/serial/io_edgeport.c +++ b/drivers/usb/serial/io_edgeport.c | |||
@@ -205,8 +205,7 @@ static void edge_bulk_out_data_callback(struct urb *urb); | |||
205 | static void edge_bulk_out_cmd_callback(struct urb *urb); | 205 | static void edge_bulk_out_cmd_callback(struct urb *urb); |
206 | 206 | ||
207 | /* function prototypes for the usbserial callbacks */ | 207 | /* function prototypes for the usbserial callbacks */ |
208 | static int edge_open(struct tty_struct *tty, struct usb_serial_port *port, | 208 | static int edge_open(struct tty_struct *tty, struct usb_serial_port *port); |
209 | struct file *filp); | ||
210 | static void edge_close(struct usb_serial_port *port); | 209 | static void edge_close(struct usb_serial_port *port); |
211 | static int edge_write(struct tty_struct *tty, struct usb_serial_port *port, | 210 | static int edge_write(struct tty_struct *tty, struct usb_serial_port *port, |
212 | const unsigned char *buf, int count); | 211 | const unsigned char *buf, int count); |
@@ -852,8 +851,7 @@ static void edge_bulk_out_cmd_callback(struct urb *urb) | |||
852 | * If successful, we return 0 | 851 | * If successful, we return 0 |
853 | * Otherwise we return a negative error number. | 852 | * Otherwise we return a negative error number. |
854 | *****************************************************************************/ | 853 | *****************************************************************************/ |
855 | static int edge_open(struct tty_struct *tty, | 854 | static int edge_open(struct tty_struct *tty, struct usb_serial_port *port) |
856 | struct usb_serial_port *port, struct file *filp) | ||
857 | { | 855 | { |
858 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 856 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); |
859 | struct usb_serial *serial; | 857 | struct usb_serial *serial; |
diff --git a/drivers/usb/serial/io_ti.c b/drivers/usb/serial/io_ti.c index e8bc42f92e79..d4cc0f7af400 100644 --- a/drivers/usb/serial/io_ti.c +++ b/drivers/usb/serial/io_ti.c | |||
@@ -1831,8 +1831,7 @@ static void edge_bulk_out_callback(struct urb *urb) | |||
1831 | tty_kref_put(tty); | 1831 | tty_kref_put(tty); |
1832 | } | 1832 | } |
1833 | 1833 | ||
1834 | static int edge_open(struct tty_struct *tty, | 1834 | static int edge_open(struct tty_struct *tty, struct usb_serial_port *port) |
1835 | struct usb_serial_port *port, struct file *filp) | ||
1836 | { | 1835 | { |
1837 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 1836 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); |
1838 | struct edgeport_serial *edge_serial; | 1837 | struct edgeport_serial *edge_serial; |
diff --git a/drivers/usb/serial/ipaq.c b/drivers/usb/serial/ipaq.c index 2545d45ce16f..24fcc64b837d 100644 --- a/drivers/usb/serial/ipaq.c +++ b/drivers/usb/serial/ipaq.c | |||
@@ -75,7 +75,7 @@ static int initial_wait; | |||
75 | 75 | ||
76 | /* Function prototypes for an ipaq */ | 76 | /* Function prototypes for an ipaq */ |
77 | static int ipaq_open(struct tty_struct *tty, | 77 | static int ipaq_open(struct tty_struct *tty, |
78 | struct usb_serial_port *port, struct file *filp); | 78 | struct usb_serial_port *port); |
79 | static void ipaq_close(struct usb_serial_port *port); | 79 | static void ipaq_close(struct usb_serial_port *port); |
80 | static int ipaq_calc_num_ports(struct usb_serial *serial); | 80 | static int ipaq_calc_num_ports(struct usb_serial *serial); |
81 | static int ipaq_startup(struct usb_serial *serial); | 81 | static int ipaq_startup(struct usb_serial *serial); |
@@ -587,7 +587,7 @@ static int bytes_in; | |||
587 | static int bytes_out; | 587 | static int bytes_out; |
588 | 588 | ||
589 | static int ipaq_open(struct tty_struct *tty, | 589 | static int ipaq_open(struct tty_struct *tty, |
590 | struct usb_serial_port *port, struct file *filp) | 590 | struct usb_serial_port *port) |
591 | { | 591 | { |
592 | struct usb_serial *serial = port->serial; | 592 | struct usb_serial *serial = port->serial; |
593 | struct ipaq_private *priv; | 593 | struct ipaq_private *priv; |
@@ -628,11 +628,6 @@ static int ipaq_open(struct tty_struct *tty, | |||
628 | priv->free_len += PACKET_SIZE; | 628 | priv->free_len += PACKET_SIZE; |
629 | } | 629 | } |
630 | 630 | ||
631 | if (tty) { | ||
632 | /* FIXME: These two are bogus */ | ||
633 | tty->raw = 1; | ||
634 | tty->real_raw = 1; | ||
635 | } | ||
636 | /* | 631 | /* |
637 | * Lose the small buffers usbserial provides. Make larger ones. | 632 | * Lose the small buffers usbserial provides. Make larger ones. |
638 | */ | 633 | */ |
diff --git a/drivers/usb/serial/ipw.c b/drivers/usb/serial/ipw.c index 29ad038b9c8d..727d323f092a 100644 --- a/drivers/usb/serial/ipw.c +++ b/drivers/usb/serial/ipw.c | |||
@@ -193,8 +193,7 @@ static void ipw_read_bulk_callback(struct urb *urb) | |||
193 | return; | 193 | return; |
194 | } | 194 | } |
195 | 195 | ||
196 | static int ipw_open(struct tty_struct *tty, | 196 | static int ipw_open(struct tty_struct *tty, struct usb_serial_port *port) |
197 | struct usb_serial_port *port, struct file *filp) | ||
198 | { | 197 | { |
199 | struct usb_device *dev = port->serial->dev; | 198 | struct usb_device *dev = port->serial->dev; |
200 | u8 buf_flow_static[16] = IPW_BYTES_FLOWINIT; | 199 | u8 buf_flow_static[16] = IPW_BYTES_FLOWINIT; |
diff --git a/drivers/usb/serial/ir-usb.c b/drivers/usb/serial/ir-usb.c index 66009b6b763a..95d8d26b9a44 100644 --- a/drivers/usb/serial/ir-usb.c +++ b/drivers/usb/serial/ir-usb.c | |||
@@ -86,8 +86,7 @@ static int buffer_size; | |||
86 | static int xbof = -1; | 86 | static int xbof = -1; |
87 | 87 | ||
88 | static int ir_startup (struct usb_serial *serial); | 88 | static int ir_startup (struct usb_serial *serial); |
89 | static int ir_open(struct tty_struct *tty, struct usb_serial_port *port, | 89 | static int ir_open(struct tty_struct *tty, struct usb_serial_port *port); |
90 | struct file *filep); | ||
91 | static void ir_close(struct usb_serial_port *port); | 90 | static void ir_close(struct usb_serial_port *port); |
92 | static int ir_write(struct tty_struct *tty, struct usb_serial_port *port, | 91 | static int ir_write(struct tty_struct *tty, struct usb_serial_port *port, |
93 | const unsigned char *buf, int count); | 92 | const unsigned char *buf, int count); |
@@ -296,8 +295,7 @@ static int ir_startup(struct usb_serial *serial) | |||
296 | return 0; | 295 | return 0; |
297 | } | 296 | } |
298 | 297 | ||
299 | static int ir_open(struct tty_struct *tty, | 298 | static int ir_open(struct tty_struct *tty, struct usb_serial_port *port) |
300 | struct usb_serial_port *port, struct file *filp) | ||
301 | { | 299 | { |
302 | char *buffer; | 300 | char *buffer; |
303 | int result = 0; | 301 | int result = 0; |
diff --git a/drivers/usb/serial/iuu_phoenix.c b/drivers/usb/serial/iuu_phoenix.c index 96873a7a32b0..6138c1cda35f 100644 --- a/drivers/usb/serial/iuu_phoenix.c +++ b/drivers/usb/serial/iuu_phoenix.c | |||
@@ -71,7 +71,6 @@ struct iuu_private { | |||
71 | spinlock_t lock; /* store irq state */ | 71 | spinlock_t lock; /* store irq state */ |
72 | wait_queue_head_t delta_msr_wait; | 72 | wait_queue_head_t delta_msr_wait; |
73 | u8 line_status; | 73 | u8 line_status; |
74 | u8 termios_initialized; | ||
75 | int tiostatus; /* store IUART SIGNAL for tiocmget call */ | 74 | int tiostatus; /* store IUART SIGNAL for tiocmget call */ |
76 | u8 reset; /* if 1 reset is needed */ | 75 | u8 reset; /* if 1 reset is needed */ |
77 | int poll; /* number of poll */ | 76 | int poll; /* number of poll */ |
@@ -1018,14 +1017,24 @@ static void iuu_close(struct usb_serial_port *port) | |||
1018 | } | 1017 | } |
1019 | } | 1018 | } |
1020 | 1019 | ||
1021 | static int iuu_open(struct tty_struct *tty, | 1020 | static void iuu_init_termios(struct tty_struct *tty) |
1022 | struct usb_serial_port *port, struct file *filp) | 1021 | { |
1022 | *(tty->termios) = tty_std_termios; | ||
1023 | tty->termios->c_cflag = CLOCAL | CREAD | CS8 | B9600 | ||
1024 | | TIOCM_CTS | CSTOPB | PARENB; | ||
1025 | tty->termios->c_ispeed = 9600; | ||
1026 | tty->termios->c_ospeed = 9600; | ||
1027 | tty->termios->c_lflag = 0; | ||
1028 | tty->termios->c_oflag = 0; | ||
1029 | tty->termios->c_iflag = 0; | ||
1030 | } | ||
1031 | |||
1032 | static int iuu_open(struct tty_struct *tty, struct usb_serial_port *port) | ||
1023 | { | 1033 | { |
1024 | struct usb_serial *serial = port->serial; | 1034 | struct usb_serial *serial = port->serial; |
1025 | u8 *buf; | 1035 | u8 *buf; |
1026 | int result; | 1036 | int result; |
1027 | u32 actual; | 1037 | u32 actual; |
1028 | unsigned long flags; | ||
1029 | struct iuu_private *priv = usb_get_serial_port_data(port); | 1038 | struct iuu_private *priv = usb_get_serial_port_data(port); |
1030 | 1039 | ||
1031 | dbg("%s - port %d", __func__, port->number); | 1040 | dbg("%s - port %d", __func__, port->number); |
@@ -1064,21 +1073,7 @@ static int iuu_open(struct tty_struct *tty, | |||
1064 | port->bulk_in_buffer, 512, | 1073 | port->bulk_in_buffer, 512, |
1065 | NULL, NULL); | 1074 | NULL, NULL); |
1066 | 1075 | ||
1067 | /* set the termios structure */ | 1076 | priv->poll = 0; |
1068 | spin_lock_irqsave(&priv->lock, flags); | ||
1069 | if (tty && !priv->termios_initialized) { | ||
1070 | *(tty->termios) = tty_std_termios; | ||
1071 | tty->termios->c_cflag = CLOCAL | CREAD | CS8 | B9600 | ||
1072 | | TIOCM_CTS | CSTOPB | PARENB; | ||
1073 | tty->termios->c_ispeed = 9600; | ||
1074 | tty->termios->c_ospeed = 9600; | ||
1075 | tty->termios->c_lflag = 0; | ||
1076 | tty->termios->c_oflag = 0; | ||
1077 | tty->termios->c_iflag = 0; | ||
1078 | priv->termios_initialized = 1; | ||
1079 | priv->poll = 0; | ||
1080 | } | ||
1081 | spin_unlock_irqrestore(&priv->lock, flags); | ||
1082 | 1077 | ||
1083 | /* initialize writebuf */ | 1078 | /* initialize writebuf */ |
1084 | #define FISH(a, b, c, d) do { \ | 1079 | #define FISH(a, b, c, d) do { \ |
@@ -1201,6 +1196,7 @@ static struct usb_serial_driver iuu_device = { | |||
1201 | .tiocmget = iuu_tiocmget, | 1196 | .tiocmget = iuu_tiocmget, |
1202 | .tiocmset = iuu_tiocmset, | 1197 | .tiocmset = iuu_tiocmset, |
1203 | .set_termios = iuu_set_termios, | 1198 | .set_termios = iuu_set_termios, |
1199 | .init_termios = iuu_init_termios, | ||
1204 | .attach = iuu_startup, | 1200 | .attach = iuu_startup, |
1205 | .release = iuu_release, | 1201 | .release = iuu_release, |
1206 | }; | 1202 | }; |
diff --git a/drivers/usb/serial/keyspan.c b/drivers/usb/serial/keyspan.c index 2594b8743d3f..f8c4b07033ff 100644 --- a/drivers/usb/serial/keyspan.c +++ b/drivers/usb/serial/keyspan.c | |||
@@ -1209,8 +1209,7 @@ static int keyspan_write_room(struct tty_struct *tty) | |||
1209 | } | 1209 | } |
1210 | 1210 | ||
1211 | 1211 | ||
1212 | static int keyspan_open(struct tty_struct *tty, | 1212 | static int keyspan_open(struct tty_struct *tty, struct usb_serial_port *port) |
1213 | struct usb_serial_port *port, struct file *filp) | ||
1214 | { | 1213 | { |
1215 | struct keyspan_port_private *p_priv; | 1214 | struct keyspan_port_private *p_priv; |
1216 | struct keyspan_serial_private *s_priv; | 1215 | struct keyspan_serial_private *s_priv; |
diff --git a/drivers/usb/serial/keyspan.h b/drivers/usb/serial/keyspan.h index 3107ed15af64..30771e5b3973 100644 --- a/drivers/usb/serial/keyspan.h +++ b/drivers/usb/serial/keyspan.h | |||
@@ -36,8 +36,7 @@ | |||
36 | 36 | ||
37 | /* Function prototypes for Keyspan serial converter */ | 37 | /* Function prototypes for Keyspan serial converter */ |
38 | static int keyspan_open (struct tty_struct *tty, | 38 | static int keyspan_open (struct tty_struct *tty, |
39 | struct usb_serial_port *port, | 39 | struct usb_serial_port *port); |
40 | struct file *filp); | ||
41 | static void keyspan_close (struct usb_serial_port *port); | 40 | static void keyspan_close (struct usb_serial_port *port); |
42 | static void keyspan_dtr_rts (struct usb_serial_port *port, int on); | 41 | static void keyspan_dtr_rts (struct usb_serial_port *port, int on); |
43 | static int keyspan_startup (struct usb_serial *serial); | 42 | static int keyspan_startup (struct usb_serial *serial); |
diff --git a/drivers/usb/serial/keyspan_pda.c b/drivers/usb/serial/keyspan_pda.c index d0b12e40c2b1..257c16cc6b2a 100644 --- a/drivers/usb/serial/keyspan_pda.c +++ b/drivers/usb/serial/keyspan_pda.c | |||
@@ -681,7 +681,7 @@ static int keyspan_pda_carrier_raised(struct usb_serial_port *port) | |||
681 | 681 | ||
682 | 682 | ||
683 | static int keyspan_pda_open(struct tty_struct *tty, | 683 | static int keyspan_pda_open(struct tty_struct *tty, |
684 | struct usb_serial_port *port, struct file *filp) | 684 | struct usb_serial_port *port) |
685 | { | 685 | { |
686 | struct usb_serial *serial = port->serial; | 686 | struct usb_serial *serial = port->serial; |
687 | unsigned char room; | 687 | unsigned char room; |
diff --git a/drivers/usb/serial/kl5kusb105.c b/drivers/usb/serial/kl5kusb105.c index 0f44bb8e8d4f..a61673133d7d 100644 --- a/drivers/usb/serial/kl5kusb105.c +++ b/drivers/usb/serial/kl5kusb105.c | |||
@@ -75,8 +75,7 @@ static int debug; | |||
75 | static int klsi_105_startup(struct usb_serial *serial); | 75 | static int klsi_105_startup(struct usb_serial *serial); |
76 | static void klsi_105_disconnect(struct usb_serial *serial); | 76 | static void klsi_105_disconnect(struct usb_serial *serial); |
77 | static void klsi_105_release(struct usb_serial *serial); | 77 | static void klsi_105_release(struct usb_serial *serial); |
78 | static int klsi_105_open(struct tty_struct *tty, | 78 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port); |
79 | struct usb_serial_port *port, struct file *filp); | ||
80 | static void klsi_105_close(struct usb_serial_port *port); | 79 | static void klsi_105_close(struct usb_serial_port *port); |
81 | static int klsi_105_write(struct tty_struct *tty, | 80 | static int klsi_105_write(struct tty_struct *tty, |
82 | struct usb_serial_port *port, const unsigned char *buf, int count); | 81 | struct usb_serial_port *port, const unsigned char *buf, int count); |
@@ -358,8 +357,7 @@ static void klsi_105_release(struct usb_serial *serial) | |||
358 | } | 357 | } |
359 | } /* klsi_105_release */ | 358 | } /* klsi_105_release */ |
360 | 359 | ||
361 | static int klsi_105_open(struct tty_struct *tty, | 360 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port) |
362 | struct usb_serial_port *port, struct file *filp) | ||
363 | { | 361 | { |
364 | struct klsi_105_private *priv = usb_get_serial_port_data(port); | 362 | struct klsi_105_private *priv = usb_get_serial_port_data(port); |
365 | int retval = 0; | 363 | int retval = 0; |
@@ -371,10 +369,6 @@ static int klsi_105_open(struct tty_struct *tty, | |||
371 | 369 | ||
372 | dbg("%s port %d", __func__, port->number); | 370 | dbg("%s port %d", __func__, port->number); |
373 | 371 | ||
374 | /* force low_latency on so that our tty_push actually forces | ||
375 | * the data through | ||
376 | * tty->low_latency = 1; */ | ||
377 | |||
378 | /* Do a defined restart: | 372 | /* Do a defined restart: |
379 | * Set up sane default baud rate and send the 'READ_ON' | 373 | * Set up sane default baud rate and send the 'READ_ON' |
380 | * vendor command. | 374 | * vendor command. |
diff --git a/drivers/usb/serial/kobil_sct.c b/drivers/usb/serial/kobil_sct.c index 6db0e561f680..45ea694b3ae6 100644 --- a/drivers/usb/serial/kobil_sct.c +++ b/drivers/usb/serial/kobil_sct.c | |||
@@ -70,8 +70,7 @@ static int debug; | |||
70 | /* Function prototypes */ | 70 | /* Function prototypes */ |
71 | static int kobil_startup(struct usb_serial *serial); | 71 | static int kobil_startup(struct usb_serial *serial); |
72 | static void kobil_release(struct usb_serial *serial); | 72 | static void kobil_release(struct usb_serial *serial); |
73 | static int kobil_open(struct tty_struct *tty, | 73 | static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port); |
74 | struct usb_serial_port *port, struct file *filp); | ||
75 | static void kobil_close(struct usb_serial_port *port); | 74 | static void kobil_close(struct usb_serial_port *port); |
76 | static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port, | 75 | static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port, |
77 | const unsigned char *buf, int count); | 76 | const unsigned char *buf, int count); |
@@ -85,7 +84,7 @@ static void kobil_read_int_callback(struct urb *urb); | |||
85 | static void kobil_write_callback(struct urb *purb); | 84 | static void kobil_write_callback(struct urb *purb); |
86 | static void kobil_set_termios(struct tty_struct *tty, | 85 | static void kobil_set_termios(struct tty_struct *tty, |
87 | struct usb_serial_port *port, struct ktermios *old); | 86 | struct usb_serial_port *port, struct ktermios *old); |
88 | 87 | static void kobil_init_termios(struct tty_struct *tty); | |
89 | 88 | ||
90 | static struct usb_device_id id_table [] = { | 89 | static struct usb_device_id id_table [] = { |
91 | { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_B_PRODUCT_ID) }, | 90 | { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_B_PRODUCT_ID) }, |
@@ -120,6 +119,7 @@ static struct usb_serial_driver kobil_device = { | |||
120 | .release = kobil_release, | 119 | .release = kobil_release, |
121 | .ioctl = kobil_ioctl, | 120 | .ioctl = kobil_ioctl, |
122 | .set_termios = kobil_set_termios, | 121 | .set_termios = kobil_set_termios, |
122 | .init_termios = kobil_init_termios, | ||
123 | .tiocmget = kobil_tiocmget, | 123 | .tiocmget = kobil_tiocmget, |
124 | .tiocmset = kobil_tiocmset, | 124 | .tiocmset = kobil_tiocmset, |
125 | .open = kobil_open, | 125 | .open = kobil_open, |
@@ -210,9 +210,17 @@ static void kobil_release(struct usb_serial *serial) | |||
210 | kfree(usb_get_serial_port_data(serial->port[i])); | 210 | kfree(usb_get_serial_port_data(serial->port[i])); |
211 | } | 211 | } |
212 | 212 | ||
213 | static void kobil_init_termios(struct tty_struct *tty) | ||
214 | { | ||
215 | /* Default to echo off and other sane device settings */ | ||
216 | tty->termios->c_lflag = 0; | ||
217 | tty->termios->c_lflag &= ~(ISIG | ICANON | ECHO | IEXTEN | XCASE); | ||
218 | tty->termios->c_iflag = IGNBRK | IGNPAR | IXOFF; | ||
219 | /* do NOT translate CR to CR-NL (0x0A -> 0x0A 0x0D) */ | ||
220 | tty->termios->c_oflag &= ~ONLCR; | ||
221 | } | ||
213 | 222 | ||
214 | static int kobil_open(struct tty_struct *tty, | 223 | static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port) |
215 | struct usb_serial_port *port, struct file *filp) | ||
216 | { | 224 | { |
217 | int result = 0; | 225 | int result = 0; |
218 | struct kobil_private *priv; | 226 | struct kobil_private *priv; |
@@ -226,16 +234,6 @@ static int kobil_open(struct tty_struct *tty, | |||
226 | /* someone sets the dev to 0 if the close method has been called */ | 234 | /* someone sets the dev to 0 if the close method has been called */ |
227 | port->interrupt_in_urb->dev = port->serial->dev; | 235 | port->interrupt_in_urb->dev = port->serial->dev; |
228 | 236 | ||
229 | if (tty) { | ||
230 | |||
231 | /* Default to echo off and other sane device settings */ | ||
232 | tty->termios->c_lflag = 0; | ||
233 | tty->termios->c_lflag &= ~(ISIG | ICANON | ECHO | IEXTEN | | ||
234 | XCASE); | ||
235 | tty->termios->c_iflag = IGNBRK | IGNPAR | IXOFF; | ||
236 | /* do NOT translate CR to CR-NL (0x0A -> 0x0A 0x0D) */ | ||
237 | tty->termios->c_oflag &= ~ONLCR; | ||
238 | } | ||
239 | /* allocate memory for transfer buffer */ | 237 | /* allocate memory for transfer buffer */ |
240 | transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL); | 238 | transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL); |
241 | if (!transfer_buffer) | 239 | if (!transfer_buffer) |
diff --git a/drivers/usb/serial/mct_u232.c b/drivers/usb/serial/mct_u232.c index d8825e159aa5..ad4998bbf16f 100644 --- a/drivers/usb/serial/mct_u232.c +++ b/drivers/usb/serial/mct_u232.c | |||
@@ -93,8 +93,7 @@ static int debug; | |||
93 | */ | 93 | */ |
94 | static int mct_u232_startup(struct usb_serial *serial); | 94 | static int mct_u232_startup(struct usb_serial *serial); |
95 | static void mct_u232_release(struct usb_serial *serial); | 95 | static void mct_u232_release(struct usb_serial *serial); |
96 | static int mct_u232_open(struct tty_struct *tty, | 96 | static int mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port); |
97 | struct usb_serial_port *port, struct file *filp); | ||
98 | static void mct_u232_close(struct usb_serial_port *port); | 97 | static void mct_u232_close(struct usb_serial_port *port); |
99 | static void mct_u232_dtr_rts(struct usb_serial_port *port, int on); | 98 | static void mct_u232_dtr_rts(struct usb_serial_port *port, int on); |
100 | static void mct_u232_read_int_callback(struct urb *urb); | 99 | static void mct_u232_read_int_callback(struct urb *urb); |
@@ -421,8 +420,7 @@ static void mct_u232_release(struct usb_serial *serial) | |||
421 | } | 420 | } |
422 | } /* mct_u232_release */ | 421 | } /* mct_u232_release */ |
423 | 422 | ||
424 | static int mct_u232_open(struct tty_struct *tty, | 423 | static int mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port) |
425 | struct usb_serial_port *port, struct file *filp) | ||
426 | { | 424 | { |
427 | struct usb_serial *serial = port->serial; | 425 | struct usb_serial *serial = port->serial; |
428 | struct mct_u232_private *priv = usb_get_serial_port_data(port); | 426 | struct mct_u232_private *priv = usb_get_serial_port_data(port); |
@@ -568,10 +566,13 @@ static void mct_u232_read_int_callback(struct urb *urb) | |||
568 | * Work-a-round: handle the 'usual' bulk-in pipe here | 566 | * Work-a-round: handle the 'usual' bulk-in pipe here |
569 | */ | 567 | */ |
570 | if (urb->transfer_buffer_length > 2) { | 568 | if (urb->transfer_buffer_length > 2) { |
571 | tty = tty_port_tty_get(&port->port); | ||
572 | if (urb->actual_length) { | 569 | if (urb->actual_length) { |
573 | tty_insert_flip_string(tty, data, urb->actual_length); | 570 | tty = tty_port_tty_get(&port->port); |
574 | tty_flip_buffer_push(tty); | 571 | if (tty) { |
572 | tty_insert_flip_string(tty, data, | ||
573 | urb->actual_length); | ||
574 | tty_flip_buffer_push(tty); | ||
575 | } | ||
575 | tty_kref_put(tty); | 576 | tty_kref_put(tty); |
576 | } | 577 | } |
577 | goto exit; | 578 | goto exit; |
diff --git a/drivers/usb/serial/mos7720.c b/drivers/usb/serial/mos7720.c index ccd4dd340d2c..763e32a44be0 100644 --- a/drivers/usb/serial/mos7720.c +++ b/drivers/usb/serial/mos7720.c | |||
@@ -85,7 +85,7 @@ static int debug; | |||
85 | #define MOSCHIP_DEVICE_ID_7720 0x7720 | 85 | #define MOSCHIP_DEVICE_ID_7720 0x7720 |
86 | #define MOSCHIP_DEVICE_ID_7715 0x7715 | 86 | #define MOSCHIP_DEVICE_ID_7715 0x7715 |
87 | 87 | ||
88 | static struct usb_device_id moschip_port_id_table [] = { | 88 | static struct usb_device_id moschip_port_id_table[] = { |
89 | { USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7720) }, | 89 | { USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7720) }, |
90 | { } /* terminating entry */ | 90 | { } /* terminating entry */ |
91 | }; | 91 | }; |
@@ -319,8 +319,7 @@ static int send_mos_cmd(struct usb_serial *serial, __u8 request, __u16 value, | |||
319 | return status; | 319 | return status; |
320 | } | 320 | } |
321 | 321 | ||
322 | static int mos7720_open(struct tty_struct *tty, | 322 | static int mos7720_open(struct tty_struct *tty, struct usb_serial_port *port) |
323 | struct usb_serial_port *port, struct file *filp) | ||
324 | { | 323 | { |
325 | struct usb_serial *serial; | 324 | struct usb_serial *serial; |
326 | struct usb_serial_port *port0; | 325 | struct usb_serial_port *port0; |
@@ -378,10 +377,14 @@ static int mos7720_open(struct tty_struct *tty, | |||
378 | /* Initialize MCS7720 -- Write Init values to corresponding Registers | 377 | /* Initialize MCS7720 -- Write Init values to corresponding Registers |
379 | * | 378 | * |
380 | * Register Index | 379 | * Register Index |
380 | * 0 : THR/RHR | ||
381 | * 1 : IER | 381 | * 1 : IER |
382 | * 2 : FCR | 382 | * 2 : FCR |
383 | * 3 : LCR | 383 | * 3 : LCR |
384 | * 4 : MCR | 384 | * 4 : MCR |
385 | * 5 : LSR | ||
386 | * 6 : MSR | ||
387 | * 7 : SPR | ||
385 | * | 388 | * |
386 | * 0x08 : SP1/2 Control Reg | 389 | * 0x08 : SP1/2 Control Reg |
387 | */ | 390 | */ |
@@ -1250,20 +1253,88 @@ static void mos7720_set_termios(struct tty_struct *tty, | |||
1250 | static int get_lsr_info(struct tty_struct *tty, | 1253 | static int get_lsr_info(struct tty_struct *tty, |
1251 | struct moschip_port *mos7720_port, unsigned int __user *value) | 1254 | struct moschip_port *mos7720_port, unsigned int __user *value) |
1252 | { | 1255 | { |
1253 | int count; | 1256 | struct usb_serial_port *port = tty->driver_data; |
1254 | unsigned int result = 0; | 1257 | unsigned int result = 0; |
1258 | unsigned char data = 0; | ||
1259 | int port_number = port->number - port->serial->minor; | ||
1260 | int count; | ||
1255 | 1261 | ||
1256 | count = mos7720_chars_in_buffer(tty); | 1262 | count = mos7720_chars_in_buffer(tty); |
1257 | if (count == 0) { | 1263 | if (count == 0) { |
1258 | dbg("%s -- Empty", __func__); | 1264 | send_mos_cmd(port->serial, MOS_READ, port_number, |
1259 | result = TIOCSER_TEMT; | 1265 | UART_LSR, &data); |
1266 | if ((data & (UART_LSR_TEMT | UART_LSR_THRE)) | ||
1267 | == (UART_LSR_TEMT | UART_LSR_THRE)) { | ||
1268 | dbg("%s -- Empty", __func__); | ||
1269 | result = TIOCSER_TEMT; | ||
1270 | } | ||
1260 | } | 1271 | } |
1261 | |||
1262 | if (copy_to_user(value, &result, sizeof(int))) | 1272 | if (copy_to_user(value, &result, sizeof(int))) |
1263 | return -EFAULT; | 1273 | return -EFAULT; |
1264 | return 0; | 1274 | return 0; |
1265 | } | 1275 | } |
1266 | 1276 | ||
1277 | static int mos7720_tiocmget(struct tty_struct *tty, struct file *file) | ||
1278 | { | ||
1279 | struct usb_serial_port *port = tty->driver_data; | ||
1280 | struct moschip_port *mos7720_port = usb_get_serial_port_data(port); | ||
1281 | unsigned int result = 0; | ||
1282 | unsigned int mcr ; | ||
1283 | unsigned int msr ; | ||
1284 | |||
1285 | dbg("%s - port %d", __func__, port->number); | ||
1286 | |||
1287 | mcr = mos7720_port->shadowMCR; | ||
1288 | msr = mos7720_port->shadowMSR; | ||
1289 | |||
1290 | result = ((mcr & UART_MCR_DTR) ? TIOCM_DTR : 0) /* 0x002 */ | ||
1291 | | ((mcr & UART_MCR_RTS) ? TIOCM_RTS : 0) /* 0x004 */ | ||
1292 | | ((msr & UART_MSR_CTS) ? TIOCM_CTS : 0) /* 0x020 */ | ||
1293 | | ((msr & UART_MSR_DCD) ? TIOCM_CAR : 0) /* 0x040 */ | ||
1294 | | ((msr & UART_MSR_RI) ? TIOCM_RI : 0) /* 0x080 */ | ||
1295 | | ((msr & UART_MSR_DSR) ? TIOCM_DSR : 0); /* 0x100 */ | ||
1296 | |||
1297 | dbg("%s -- %x", __func__, result); | ||
1298 | |||
1299 | return result; | ||
1300 | } | ||
1301 | |||
1302 | static int mos7720_tiocmset(struct tty_struct *tty, struct file *file, | ||
1303 | unsigned int set, unsigned int clear) | ||
1304 | { | ||
1305 | struct usb_serial_port *port = tty->driver_data; | ||
1306 | struct moschip_port *mos7720_port = usb_get_serial_port_data(port); | ||
1307 | unsigned int mcr ; | ||
1308 | unsigned char lmcr; | ||
1309 | |||
1310 | dbg("%s - port %d", __func__, port->number); | ||
1311 | dbg("he was at tiocmget"); | ||
1312 | |||
1313 | mcr = mos7720_port->shadowMCR; | ||
1314 | |||
1315 | if (set & TIOCM_RTS) | ||
1316 | mcr |= UART_MCR_RTS; | ||
1317 | if (set & TIOCM_DTR) | ||
1318 | mcr |= UART_MCR_DTR; | ||
1319 | if (set & TIOCM_LOOP) | ||
1320 | mcr |= UART_MCR_LOOP; | ||
1321 | |||
1322 | if (clear & TIOCM_RTS) | ||
1323 | mcr &= ~UART_MCR_RTS; | ||
1324 | if (clear & TIOCM_DTR) | ||
1325 | mcr &= ~UART_MCR_DTR; | ||
1326 | if (clear & TIOCM_LOOP) | ||
1327 | mcr &= ~UART_MCR_LOOP; | ||
1328 | |||
1329 | mos7720_port->shadowMCR = mcr; | ||
1330 | lmcr = mos7720_port->shadowMCR; | ||
1331 | |||
1332 | send_mos_cmd(port->serial, MOS_WRITE, | ||
1333 | port->number - port->serial->minor, UART_MCR, &lmcr); | ||
1334 | |||
1335 | return 0; | ||
1336 | } | ||
1337 | |||
1267 | static int set_modem_info(struct moschip_port *mos7720_port, unsigned int cmd, | 1338 | static int set_modem_info(struct moschip_port *mos7720_port, unsigned int cmd, |
1268 | unsigned int __user *value) | 1339 | unsigned int __user *value) |
1269 | { | 1340 | { |
@@ -1301,14 +1372,6 @@ static int set_modem_info(struct moschip_port *mos7720_port, unsigned int cmd, | |||
1301 | mcr &= ~UART_MCR_LOOP; | 1372 | mcr &= ~UART_MCR_LOOP; |
1302 | break; | 1373 | break; |
1303 | 1374 | ||
1304 | case TIOCMSET: | ||
1305 | /* turn off the RTS and DTR and LOOPBACK | ||
1306 | * and then only turn on what was asked to */ | ||
1307 | mcr &= ~(UART_MCR_RTS | UART_MCR_DTR | UART_MCR_LOOP); | ||
1308 | mcr |= ((arg & TIOCM_RTS) ? UART_MCR_RTS : 0); | ||
1309 | mcr |= ((arg & TIOCM_DTR) ? UART_MCR_DTR : 0); | ||
1310 | mcr |= ((arg & TIOCM_LOOP) ? UART_MCR_LOOP : 0); | ||
1311 | break; | ||
1312 | } | 1375 | } |
1313 | 1376 | ||
1314 | mos7720_port->shadowMCR = mcr; | 1377 | mos7720_port->shadowMCR = mcr; |
@@ -1320,28 +1383,6 @@ static int set_modem_info(struct moschip_port *mos7720_port, unsigned int cmd, | |||
1320 | return 0; | 1383 | return 0; |
1321 | } | 1384 | } |
1322 | 1385 | ||
1323 | static int get_modem_info(struct moschip_port *mos7720_port, | ||
1324 | unsigned int __user *value) | ||
1325 | { | ||
1326 | unsigned int result = 0; | ||
1327 | unsigned int msr = mos7720_port->shadowMSR; | ||
1328 | unsigned int mcr = mos7720_port->shadowMCR; | ||
1329 | |||
1330 | result = ((mcr & UART_MCR_DTR) ? TIOCM_DTR: 0) /* 0x002 */ | ||
1331 | | ((mcr & UART_MCR_RTS) ? TIOCM_RTS: 0) /* 0x004 */ | ||
1332 | | ((msr & UART_MSR_CTS) ? TIOCM_CTS: 0) /* 0x020 */ | ||
1333 | | ((msr & UART_MSR_DCD) ? TIOCM_CAR: 0) /* 0x040 */ | ||
1334 | | ((msr & UART_MSR_RI) ? TIOCM_RI: 0) /* 0x080 */ | ||
1335 | | ((msr & UART_MSR_DSR) ? TIOCM_DSR: 0); /* 0x100 */ | ||
1336 | |||
1337 | |||
1338 | dbg("%s -- %x", __func__, result); | ||
1339 | |||
1340 | if (copy_to_user(value, &result, sizeof(int))) | ||
1341 | return -EFAULT; | ||
1342 | return 0; | ||
1343 | } | ||
1344 | |||
1345 | static int get_serial_info(struct moschip_port *mos7720_port, | 1386 | static int get_serial_info(struct moschip_port *mos7720_port, |
1346 | struct serial_struct __user *retinfo) | 1387 | struct serial_struct __user *retinfo) |
1347 | { | 1388 | { |
@@ -1392,17 +1433,11 @@ static int mos7720_ioctl(struct tty_struct *tty, struct file *file, | |||
1392 | /* FIXME: These should be using the mode methods */ | 1433 | /* FIXME: These should be using the mode methods */ |
1393 | case TIOCMBIS: | 1434 | case TIOCMBIS: |
1394 | case TIOCMBIC: | 1435 | case TIOCMBIC: |
1395 | case TIOCMSET: | ||
1396 | dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", | 1436 | dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", |
1397 | __func__, port->number); | 1437 | __func__, port->number); |
1398 | return set_modem_info(mos7720_port, cmd, | 1438 | return set_modem_info(mos7720_port, cmd, |
1399 | (unsigned int __user *)arg); | 1439 | (unsigned int __user *)arg); |
1400 | 1440 | ||
1401 | case TIOCMGET: | ||
1402 | dbg("%s (%d) TIOCMGET", __func__, port->number); | ||
1403 | return get_modem_info(mos7720_port, | ||
1404 | (unsigned int __user *)arg); | ||
1405 | |||
1406 | case TIOCGSERIAL: | 1441 | case TIOCGSERIAL: |
1407 | dbg("%s (%d) TIOCGSERIAL", __func__, port->number); | 1442 | dbg("%s (%d) TIOCGSERIAL", __func__, port->number); |
1408 | return get_serial_info(mos7720_port, | 1443 | return get_serial_info(mos7720_port, |
@@ -1557,6 +1592,8 @@ static struct usb_serial_driver moschip7720_2port_driver = { | |||
1557 | .attach = mos7720_startup, | 1592 | .attach = mos7720_startup, |
1558 | .release = mos7720_release, | 1593 | .release = mos7720_release, |
1559 | .ioctl = mos7720_ioctl, | 1594 | .ioctl = mos7720_ioctl, |
1595 | .tiocmget = mos7720_tiocmget, | ||
1596 | .tiocmset = mos7720_tiocmset, | ||
1560 | .set_termios = mos7720_set_termios, | 1597 | .set_termios = mos7720_set_termios, |
1561 | .write = mos7720_write, | 1598 | .write = mos7720_write, |
1562 | .write_room = mos7720_write_room, | 1599 | .write_room = mos7720_write_room, |
diff --git a/drivers/usb/serial/mos7840.c b/drivers/usb/serial/mos7840.c index 270009afdf77..f11abf52be7d 100644 --- a/drivers/usb/serial/mos7840.c +++ b/drivers/usb/serial/mos7840.c | |||
@@ -824,8 +824,7 @@ static int mos7840_serial_probe(struct usb_serial *serial, | |||
824 | * Otherwise we return a negative error number. | 824 | * Otherwise we return a negative error number. |
825 | *****************************************************************************/ | 825 | *****************************************************************************/ |
826 | 826 | ||
827 | static int mos7840_open(struct tty_struct *tty, | 827 | static int mos7840_open(struct tty_struct *tty, struct usb_serial_port *port) |
828 | struct usb_serial_port *port, struct file *filp) | ||
829 | { | 828 | { |
830 | int response; | 829 | int response; |
831 | int j; | 830 | int j; |
@@ -2134,106 +2133,6 @@ static int mos7840_get_lsr_info(struct tty_struct *tty, | |||
2134 | } | 2133 | } |
2135 | 2134 | ||
2136 | /***************************************************************************** | 2135 | /***************************************************************************** |
2137 | * mos7840_set_modem_info | ||
2138 | * function to set modem info | ||
2139 | *****************************************************************************/ | ||
2140 | |||
2141 | /* FIXME: Should be using the model control hooks */ | ||
2142 | |||
2143 | static int mos7840_set_modem_info(struct moschip_port *mos7840_port, | ||
2144 | unsigned int cmd, unsigned int __user *value) | ||
2145 | { | ||
2146 | unsigned int mcr; | ||
2147 | unsigned int arg; | ||
2148 | __u16 Data; | ||
2149 | int status; | ||
2150 | struct usb_serial_port *port; | ||
2151 | |||
2152 | if (mos7840_port == NULL) | ||
2153 | return -1; | ||
2154 | |||
2155 | port = (struct usb_serial_port *)mos7840_port->port; | ||
2156 | if (mos7840_port_paranoia_check(port, __func__)) { | ||
2157 | dbg("%s", "Invalid port"); | ||
2158 | return -1; | ||
2159 | } | ||
2160 | |||
2161 | mcr = mos7840_port->shadowMCR; | ||
2162 | |||
2163 | if (copy_from_user(&arg, value, sizeof(int))) | ||
2164 | return -EFAULT; | ||
2165 | |||
2166 | switch (cmd) { | ||
2167 | case TIOCMBIS: | ||
2168 | if (arg & TIOCM_RTS) | ||
2169 | mcr |= MCR_RTS; | ||
2170 | if (arg & TIOCM_DTR) | ||
2171 | mcr |= MCR_RTS; | ||
2172 | if (arg & TIOCM_LOOP) | ||
2173 | mcr |= MCR_LOOPBACK; | ||
2174 | break; | ||
2175 | |||
2176 | case TIOCMBIC: | ||
2177 | if (arg & TIOCM_RTS) | ||
2178 | mcr &= ~MCR_RTS; | ||
2179 | if (arg & TIOCM_DTR) | ||
2180 | mcr &= ~MCR_RTS; | ||
2181 | if (arg & TIOCM_LOOP) | ||
2182 | mcr &= ~MCR_LOOPBACK; | ||
2183 | break; | ||
2184 | |||
2185 | case TIOCMSET: | ||
2186 | /* turn off the RTS and DTR and LOOPBACK | ||
2187 | * and then only turn on what was asked to */ | ||
2188 | mcr &= ~(MCR_RTS | MCR_DTR | MCR_LOOPBACK); | ||
2189 | mcr |= ((arg & TIOCM_RTS) ? MCR_RTS : 0); | ||
2190 | mcr |= ((arg & TIOCM_DTR) ? MCR_DTR : 0); | ||
2191 | mcr |= ((arg & TIOCM_LOOP) ? MCR_LOOPBACK : 0); | ||
2192 | break; | ||
2193 | } | ||
2194 | |||
2195 | lock_kernel(); | ||
2196 | mos7840_port->shadowMCR = mcr; | ||
2197 | |||
2198 | Data = mos7840_port->shadowMCR; | ||
2199 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); | ||
2200 | unlock_kernel(); | ||
2201 | if (status < 0) { | ||
2202 | dbg("setting MODEM_CONTROL_REGISTER Failed"); | ||
2203 | return -1; | ||
2204 | } | ||
2205 | |||
2206 | return 0; | ||
2207 | } | ||
2208 | |||
2209 | /***************************************************************************** | ||
2210 | * mos7840_get_modem_info | ||
2211 | * function to get modem info | ||
2212 | *****************************************************************************/ | ||
2213 | |||
2214 | static int mos7840_get_modem_info(struct moschip_port *mos7840_port, | ||
2215 | unsigned int __user *value) | ||
2216 | { | ||
2217 | unsigned int result = 0; | ||
2218 | __u16 msr; | ||
2219 | unsigned int mcr = mos7840_port->shadowMCR; | ||
2220 | mos7840_get_uart_reg(mos7840_port->port, | ||
2221 | MODEM_STATUS_REGISTER, &msr); | ||
2222 | result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) /* 0x002 */ | ||
2223 | |((mcr & MCR_RTS) ? TIOCM_RTS : 0) /* 0x004 */ | ||
2224 | |((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0) /* 0x020 */ | ||
2225 | |((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0) /* 0x040 */ | ||
2226 | |((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0) /* 0x080 */ | ||
2227 | |((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0); /* 0x100 */ | ||
2228 | |||
2229 | dbg("%s -- %x", __func__, result); | ||
2230 | |||
2231 | if (copy_to_user(value, &result, sizeof(int))) | ||
2232 | return -EFAULT; | ||
2233 | return 0; | ||
2234 | } | ||
2235 | |||
2236 | /***************************************************************************** | ||
2237 | * mos7840_get_serial_info | 2136 | * mos7840_get_serial_info |
2238 | * function to get information about serial port | 2137 | * function to get information about serial port |
2239 | *****************************************************************************/ | 2138 | *****************************************************************************/ |
@@ -2281,7 +2180,6 @@ static int mos7840_ioctl(struct tty_struct *tty, struct file *file, | |||
2281 | struct async_icount cnow; | 2180 | struct async_icount cnow; |
2282 | struct async_icount cprev; | 2181 | struct async_icount cprev; |
2283 | struct serial_icounter_struct icount; | 2182 | struct serial_icounter_struct icount; |
2284 | int mosret = 0; | ||
2285 | 2183 | ||
2286 | if (mos7840_port_paranoia_check(port, __func__)) { | 2184 | if (mos7840_port_paranoia_check(port, __func__)) { |
2287 | dbg("%s", "Invalid port"); | 2185 | dbg("%s", "Invalid port"); |
@@ -2303,20 +2201,6 @@ static int mos7840_ioctl(struct tty_struct *tty, struct file *file, | |||
2303 | return mos7840_get_lsr_info(tty, argp); | 2201 | return mos7840_get_lsr_info(tty, argp); |
2304 | return 0; | 2202 | return 0; |
2305 | 2203 | ||
2306 | /* FIXME: use the modem hooks and remove this */ | ||
2307 | case TIOCMBIS: | ||
2308 | case TIOCMBIC: | ||
2309 | case TIOCMSET: | ||
2310 | dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", __func__, | ||
2311 | port->number); | ||
2312 | mosret = | ||
2313 | mos7840_set_modem_info(mos7840_port, cmd, argp); | ||
2314 | return mosret; | ||
2315 | |||
2316 | case TIOCMGET: | ||
2317 | dbg("%s (%d) TIOCMGET", __func__, port->number); | ||
2318 | return mos7840_get_modem_info(mos7840_port, argp); | ||
2319 | |||
2320 | case TIOCGSERIAL: | 2204 | case TIOCGSERIAL: |
2321 | dbg("%s (%d) TIOCGSERIAL", __func__, port->number); | 2205 | dbg("%s (%d) TIOCGSERIAL", __func__, port->number); |
2322 | return mos7840_get_serial_info(mos7840_port, argp); | 2206 | return mos7840_get_serial_info(mos7840_port, argp); |
diff --git a/drivers/usb/serial/navman.c b/drivers/usb/serial/navman.c index f5f3751a888c..5ceaa4c6be09 100644 --- a/drivers/usb/serial/navman.c +++ b/drivers/usb/serial/navman.c | |||
@@ -80,8 +80,7 @@ exit: | |||
80 | __func__, result); | 80 | __func__, result); |
81 | } | 81 | } |
82 | 82 | ||
83 | static int navman_open(struct tty_struct *tty, | 83 | static int navman_open(struct tty_struct *tty, struct usb_serial_port *port) |
84 | struct usb_serial_port *port, struct file *filp) | ||
85 | { | 84 | { |
86 | int result = 0; | 85 | int result = 0; |
87 | 86 | ||
diff --git a/drivers/usb/serial/omninet.c b/drivers/usb/serial/omninet.c index 56857ddbd70b..062265038bf0 100644 --- a/drivers/usb/serial/omninet.c +++ b/drivers/usb/serial/omninet.c | |||
@@ -64,8 +64,7 @@ static int debug; | |||
64 | #define BT_IGNITIONPRO_ID 0x2000 | 64 | #define BT_IGNITIONPRO_ID 0x2000 |
65 | 65 | ||
66 | /* function prototypes */ | 66 | /* function prototypes */ |
67 | static int omninet_open(struct tty_struct *tty, struct usb_serial_port *port, | 67 | static int omninet_open(struct tty_struct *tty, struct usb_serial_port *port); |
68 | struct file *filp); | ||
69 | static void omninet_close(struct usb_serial_port *port); | 68 | static void omninet_close(struct usb_serial_port *port); |
70 | static void omninet_read_bulk_callback(struct urb *urb); | 69 | static void omninet_read_bulk_callback(struct urb *urb); |
71 | static void omninet_write_bulk_callback(struct urb *urb); | 70 | static void omninet_write_bulk_callback(struct urb *urb); |
@@ -163,8 +162,7 @@ static int omninet_attach(struct usb_serial *serial) | |||
163 | return 0; | 162 | return 0; |
164 | } | 163 | } |
165 | 164 | ||
166 | static int omninet_open(struct tty_struct *tty, | 165 | static int omninet_open(struct tty_struct *tty, struct usb_serial_port *port) |
167 | struct usb_serial_port *port, struct file *filp) | ||
168 | { | 166 | { |
169 | struct usb_serial *serial = port->serial; | 167 | struct usb_serial *serial = port->serial; |
170 | struct usb_serial_port *wport; | 168 | struct usb_serial_port *wport; |
diff --git a/drivers/usb/serial/opticon.c b/drivers/usb/serial/opticon.c index 336bba79ad32..1085a577c5c1 100644 --- a/drivers/usb/serial/opticon.c +++ b/drivers/usb/serial/opticon.c | |||
@@ -144,8 +144,7 @@ exit: | |||
144 | spin_unlock(&priv->lock); | 144 | spin_unlock(&priv->lock); |
145 | } | 145 | } |
146 | 146 | ||
147 | static int opticon_open(struct tty_struct *tty, struct usb_serial_port *port, | 147 | static int opticon_open(struct tty_struct *tty, struct usb_serial_port *port) |
148 | struct file *filp) | ||
149 | { | 148 | { |
150 | struct opticon_private *priv = usb_get_serial_data(port->serial); | 149 | struct opticon_private *priv = usb_get_serial_data(port->serial); |
151 | unsigned long flags; | 150 | unsigned long flags; |
diff --git a/drivers/usb/serial/option.c b/drivers/usb/serial/option.c index c784ddbe7b61..fe47051dbef2 100644 --- a/drivers/usb/serial/option.c +++ b/drivers/usb/serial/option.c | |||
@@ -45,8 +45,7 @@ | |||
45 | /* Function prototypes */ | 45 | /* Function prototypes */ |
46 | static int option_probe(struct usb_serial *serial, | 46 | static int option_probe(struct usb_serial *serial, |
47 | const struct usb_device_id *id); | 47 | const struct usb_device_id *id); |
48 | static int option_open(struct tty_struct *tty, struct usb_serial_port *port, | 48 | static int option_open(struct tty_struct *tty, struct usb_serial_port *port); |
49 | struct file *filp); | ||
50 | static void option_close(struct usb_serial_port *port); | 49 | static void option_close(struct usb_serial_port *port); |
51 | static void option_dtr_rts(struct usb_serial_port *port, int on); | 50 | static void option_dtr_rts(struct usb_serial_port *port, int on); |
52 | 51 | ||
@@ -961,8 +960,7 @@ static int option_chars_in_buffer(struct tty_struct *tty) | |||
961 | return data_len; | 960 | return data_len; |
962 | } | 961 | } |
963 | 962 | ||
964 | static int option_open(struct tty_struct *tty, | 963 | static int option_open(struct tty_struct *tty, struct usb_serial_port *port) |
965 | struct usb_serial_port *port, struct file *filp) | ||
966 | { | 964 | { |
967 | struct option_port_private *portdata; | 965 | struct option_port_private *portdata; |
968 | int i, err; | 966 | int i, err; |
diff --git a/drivers/usb/serial/oti6858.c b/drivers/usb/serial/oti6858.c index 3cece27325e7..0f4a70ce3823 100644 --- a/drivers/usb/serial/oti6858.c +++ b/drivers/usb/serial/oti6858.c | |||
@@ -141,11 +141,11 @@ struct oti6858_control_pkt { | |||
141 | && ((a)->frame_fmt == (priv)->pending_setup.frame_fmt)) | 141 | && ((a)->frame_fmt == (priv)->pending_setup.frame_fmt)) |
142 | 142 | ||
143 | /* function prototypes */ | 143 | /* function prototypes */ |
144 | static int oti6858_open(struct tty_struct *tty, | 144 | static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port); |
145 | struct usb_serial_port *port, struct file *filp); | ||
146 | static void oti6858_close(struct usb_serial_port *port); | 145 | static void oti6858_close(struct usb_serial_port *port); |
147 | static void oti6858_set_termios(struct tty_struct *tty, | 146 | static void oti6858_set_termios(struct tty_struct *tty, |
148 | struct usb_serial_port *port, struct ktermios *old); | 147 | struct usb_serial_port *port, struct ktermios *old); |
148 | static void oti6858_init_termios(struct tty_struct *tty); | ||
149 | static int oti6858_ioctl(struct tty_struct *tty, struct file *file, | 149 | static int oti6858_ioctl(struct tty_struct *tty, struct file *file, |
150 | unsigned int cmd, unsigned long arg); | 150 | unsigned int cmd, unsigned long arg); |
151 | static void oti6858_read_int_callback(struct urb *urb); | 151 | static void oti6858_read_int_callback(struct urb *urb); |
@@ -186,6 +186,7 @@ static struct usb_serial_driver oti6858_device = { | |||
186 | .write = oti6858_write, | 186 | .write = oti6858_write, |
187 | .ioctl = oti6858_ioctl, | 187 | .ioctl = oti6858_ioctl, |
188 | .set_termios = oti6858_set_termios, | 188 | .set_termios = oti6858_set_termios, |
189 | .init_termios = oti6858_init_termios, | ||
189 | .tiocmget = oti6858_tiocmget, | 190 | .tiocmget = oti6858_tiocmget, |
190 | .tiocmset = oti6858_tiocmset, | 191 | .tiocmset = oti6858_tiocmset, |
191 | .read_bulk_callback = oti6858_read_bulk_callback, | 192 | .read_bulk_callback = oti6858_read_bulk_callback, |
@@ -206,7 +207,6 @@ struct oti6858_private { | |||
206 | struct { | 207 | struct { |
207 | u8 read_urb_in_use; | 208 | u8 read_urb_in_use; |
208 | u8 write_urb_in_use; | 209 | u8 write_urb_in_use; |
209 | u8 termios_initialized; | ||
210 | } flags; | 210 | } flags; |
211 | struct delayed_work delayed_write_work; | 211 | struct delayed_work delayed_write_work; |
212 | 212 | ||
@@ -447,6 +447,14 @@ static int oti6858_chars_in_buffer(struct tty_struct *tty) | |||
447 | return chars; | 447 | return chars; |
448 | } | 448 | } |
449 | 449 | ||
450 | static void oti6858_init_termios(struct tty_struct *tty) | ||
451 | { | ||
452 | *(tty->termios) = tty_std_termios; | ||
453 | tty->termios->c_cflag = B38400 | CS8 | CREAD | HUPCL | CLOCAL; | ||
454 | tty->termios->c_ispeed = 38400; | ||
455 | tty->termios->c_ospeed = 38400; | ||
456 | } | ||
457 | |||
450 | static void oti6858_set_termios(struct tty_struct *tty, | 458 | static void oti6858_set_termios(struct tty_struct *tty, |
451 | struct usb_serial_port *port, struct ktermios *old_termios) | 459 | struct usb_serial_port *port, struct ktermios *old_termios) |
452 | { | 460 | { |
@@ -464,16 +472,6 @@ static void oti6858_set_termios(struct tty_struct *tty, | |||
464 | return; | 472 | return; |
465 | } | 473 | } |
466 | 474 | ||
467 | spin_lock_irqsave(&priv->lock, flags); | ||
468 | if (!priv->flags.termios_initialized) { | ||
469 | *(tty->termios) = tty_std_termios; | ||
470 | tty->termios->c_cflag = B38400 | CS8 | CREAD | HUPCL | CLOCAL; | ||
471 | tty->termios->c_ispeed = 38400; | ||
472 | tty->termios->c_ospeed = 38400; | ||
473 | priv->flags.termios_initialized = 1; | ||
474 | } | ||
475 | spin_unlock_irqrestore(&priv->lock, flags); | ||
476 | |||
477 | cflag = tty->termios->c_cflag; | 475 | cflag = tty->termios->c_cflag; |
478 | 476 | ||
479 | spin_lock_irqsave(&priv->lock, flags); | 477 | spin_lock_irqsave(&priv->lock, flags); |
@@ -566,8 +564,7 @@ static void oti6858_set_termios(struct tty_struct *tty, | |||
566 | spin_unlock_irqrestore(&priv->lock, flags); | 564 | spin_unlock_irqrestore(&priv->lock, flags); |
567 | } | 565 | } |
568 | 566 | ||
569 | static int oti6858_open(struct tty_struct *tty, | 567 | static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port) |
570 | struct usb_serial_port *port, struct file *filp) | ||
571 | { | 568 | { |
572 | struct oti6858_private *priv = usb_get_serial_port_data(port); | 569 | struct oti6858_private *priv = usb_get_serial_port_data(port); |
573 | struct ktermios tmp_termios; | 570 | struct ktermios tmp_termios; |
diff --git a/drivers/usb/serial/pl2303.c b/drivers/usb/serial/pl2303.c index 3e86815b2705..a63ea99936f7 100644 --- a/drivers/usb/serial/pl2303.c +++ b/drivers/usb/serial/pl2303.c | |||
@@ -691,8 +691,7 @@ static void pl2303_close(struct usb_serial_port *port) | |||
691 | 691 | ||
692 | } | 692 | } |
693 | 693 | ||
694 | static int pl2303_open(struct tty_struct *tty, | 694 | static int pl2303_open(struct tty_struct *tty, struct usb_serial_port *port) |
695 | struct usb_serial_port *port, struct file *filp) | ||
696 | { | 695 | { |
697 | struct ktermios tmp_termios; | 696 | struct ktermios tmp_termios; |
698 | struct usb_serial *serial = port->serial; | 697 | struct usb_serial *serial = port->serial; |
@@ -714,8 +713,6 @@ static int pl2303_open(struct tty_struct *tty, | |||
714 | if (tty) | 713 | if (tty) |
715 | pl2303_set_termios(tty, port, &tmp_termios); | 714 | pl2303_set_termios(tty, port, &tmp_termios); |
716 | 715 | ||
717 | /* FIXME: need to assert RTS and DTR if CRTSCTS off */ | ||
718 | |||
719 | dbg("%s - submitting read urb", __func__); | 716 | dbg("%s - submitting read urb", __func__); |
720 | port->read_urb->dev = serial->dev; | 717 | port->read_urb->dev = serial->dev; |
721 | result = usb_submit_urb(port->read_urb, GFP_KERNEL); | 718 | result = usb_submit_urb(port->read_urb, GFP_KERNEL); |
diff --git a/drivers/usb/serial/sierra.c b/drivers/usb/serial/sierra.c index f48d05e0acc1..55391bbe1230 100644 --- a/drivers/usb/serial/sierra.c +++ b/drivers/usb/serial/sierra.c | |||
@@ -734,8 +734,7 @@ static void sierra_close(struct usb_serial_port *port) | |||
734 | } | 734 | } |
735 | } | 735 | } |
736 | 736 | ||
737 | static int sierra_open(struct tty_struct *tty, | 737 | static int sierra_open(struct tty_struct *tty, struct usb_serial_port *port) |
738 | struct usb_serial_port *port, struct file *filp) | ||
739 | { | 738 | { |
740 | struct sierra_port_private *portdata; | 739 | struct sierra_port_private *portdata; |
741 | struct usb_serial *serial = port->serial; | 740 | struct usb_serial *serial = port->serial; |
diff --git a/drivers/usb/serial/spcp8x5.c b/drivers/usb/serial/spcp8x5.c index 3c249d8e8b8e..61e7c40b94fb 100644 --- a/drivers/usb/serial/spcp8x5.c +++ b/drivers/usb/serial/spcp8x5.c | |||
@@ -299,7 +299,6 @@ struct spcp8x5_private { | |||
299 | wait_queue_head_t delta_msr_wait; | 299 | wait_queue_head_t delta_msr_wait; |
300 | u8 line_control; | 300 | u8 line_control; |
301 | u8 line_status; | 301 | u8 line_status; |
302 | u8 termios_initialized; | ||
303 | }; | 302 | }; |
304 | 303 | ||
305 | /* desc : when device plug in,this function would be called. | 304 | /* desc : when device plug in,this function would be called. |
@@ -498,6 +497,15 @@ static void spcp8x5_close(struct usb_serial_port *port) | |||
498 | dev_dbg(&port->dev, "usb_unlink_urb(read_urb) = %d\n", result); | 497 | dev_dbg(&port->dev, "usb_unlink_urb(read_urb) = %d\n", result); |
499 | } | 498 | } |
500 | 499 | ||
500 | static void spcp8x5_init_termios(struct tty_struct *tty) | ||
501 | { | ||
502 | /* for the 1st time call this function */ | ||
503 | *(tty->termios) = tty_std_termios; | ||
504 | tty->termios->c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL; | ||
505 | tty->termios->c_ispeed = 115200; | ||
506 | tty->termios->c_ospeed = 115200; | ||
507 | } | ||
508 | |||
501 | /* set the serial param for transfer. we should check if we really need to | 509 | /* set the serial param for transfer. we should check if we really need to |
502 | * transfer. if we set flow control we should do this too. */ | 510 | * transfer. if we set flow control we should do this too. */ |
503 | static void spcp8x5_set_termios(struct tty_struct *tty, | 511 | static void spcp8x5_set_termios(struct tty_struct *tty, |
@@ -514,16 +522,6 @@ static void spcp8x5_set_termios(struct tty_struct *tty, | |||
514 | int i; | 522 | int i; |
515 | u8 control; | 523 | u8 control; |
516 | 524 | ||
517 | /* for the 1st time call this function */ | ||
518 | spin_lock_irqsave(&priv->lock, flags); | ||
519 | if (!priv->termios_initialized) { | ||
520 | *(tty->termios) = tty_std_termios; | ||
521 | tty->termios->c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL; | ||
522 | tty->termios->c_ispeed = 115200; | ||
523 | tty->termios->c_ospeed = 115200; | ||
524 | priv->termios_initialized = 1; | ||
525 | } | ||
526 | spin_unlock_irqrestore(&priv->lock, flags); | ||
527 | 525 | ||
528 | /* check that they really want us to change something */ | 526 | /* check that they really want us to change something */ |
529 | if (!tty_termios_hw_change(tty->termios, old_termios)) | 527 | if (!tty_termios_hw_change(tty->termios, old_termios)) |
@@ -623,8 +621,7 @@ static void spcp8x5_set_termios(struct tty_struct *tty, | |||
623 | 621 | ||
624 | /* open the serial port. do some usb system call. set termios and get the line | 622 | /* open the serial port. do some usb system call. set termios and get the line |
625 | * status of the device. then submit the read urb */ | 623 | * status of the device. then submit the read urb */ |
626 | static int spcp8x5_open(struct tty_struct *tty, | 624 | static int spcp8x5_open(struct tty_struct *tty, struct usb_serial_port *port) |
627 | struct usb_serial_port *port, struct file *filp) | ||
628 | { | 625 | { |
629 | struct ktermios tmp_termios; | 626 | struct ktermios tmp_termios; |
630 | struct usb_serial *serial = port->serial; | 627 | struct usb_serial *serial = port->serial; |
@@ -658,8 +655,6 @@ static int spcp8x5_open(struct tty_struct *tty, | |||
658 | priv->line_status = status & 0xf0 ; | 655 | priv->line_status = status & 0xf0 ; |
659 | spin_unlock_irqrestore(&priv->lock, flags); | 656 | spin_unlock_irqrestore(&priv->lock, flags); |
660 | 657 | ||
661 | /* FIXME: need to assert RTS and DTR if CRTSCTS off */ | ||
662 | |||
663 | dbg("%s - submitting read urb", __func__); | 658 | dbg("%s - submitting read urb", __func__); |
664 | port->read_urb->dev = serial->dev; | 659 | port->read_urb->dev = serial->dev; |
665 | ret = usb_submit_urb(port->read_urb, GFP_KERNEL); | 660 | ret = usb_submit_urb(port->read_urb, GFP_KERNEL); |
@@ -1011,6 +1006,7 @@ static struct usb_serial_driver spcp8x5_device = { | |||
1011 | .carrier_raised = spcp8x5_carrier_raised, | 1006 | .carrier_raised = spcp8x5_carrier_raised, |
1012 | .write = spcp8x5_write, | 1007 | .write = spcp8x5_write, |
1013 | .set_termios = spcp8x5_set_termios, | 1008 | .set_termios = spcp8x5_set_termios, |
1009 | .init_termios = spcp8x5_init_termios, | ||
1014 | .ioctl = spcp8x5_ioctl, | 1010 | .ioctl = spcp8x5_ioctl, |
1015 | .tiocmget = spcp8x5_tiocmget, | 1011 | .tiocmget = spcp8x5_tiocmget, |
1016 | .tiocmset = spcp8x5_tiocmset, | 1012 | .tiocmset = spcp8x5_tiocmset, |
diff --git a/drivers/usb/serial/symbolserial.c b/drivers/usb/serial/symbolserial.c index 6157fac9366b..cb7e95f9fcbf 100644 --- a/drivers/usb/serial/symbolserial.c +++ b/drivers/usb/serial/symbolserial.c | |||
@@ -124,8 +124,7 @@ exit: | |||
124 | spin_unlock(&priv->lock); | 124 | spin_unlock(&priv->lock); |
125 | } | 125 | } |
126 | 126 | ||
127 | static int symbol_open(struct tty_struct *tty, struct usb_serial_port *port, | 127 | static int symbol_open(struct tty_struct *tty, struct usb_serial_port *port) |
128 | struct file *filp) | ||
129 | { | 128 | { |
130 | struct symbol_private *priv = usb_get_serial_data(port->serial); | 129 | struct symbol_private *priv = usb_get_serial_data(port->serial); |
131 | unsigned long flags; | 130 | unsigned long flags; |
diff --git a/drivers/usb/serial/ti_usb_3410_5052.c b/drivers/usb/serial/ti_usb_3410_5052.c index 3bc609fe2242..1e9dc8821698 100644 --- a/drivers/usb/serial/ti_usb_3410_5052.c +++ b/drivers/usb/serial/ti_usb_3410_5052.c | |||
@@ -98,8 +98,7 @@ struct ti_device { | |||
98 | 98 | ||
99 | static int ti_startup(struct usb_serial *serial); | 99 | static int ti_startup(struct usb_serial *serial); |
100 | static void ti_release(struct usb_serial *serial); | 100 | static void ti_release(struct usb_serial *serial); |
101 | static int ti_open(struct tty_struct *tty, struct usb_serial_port *port, | 101 | static int ti_open(struct tty_struct *tty, struct usb_serial_port *port); |
102 | struct file *file); | ||
103 | static void ti_close(struct usb_serial_port *port); | 102 | static void ti_close(struct usb_serial_port *port); |
104 | static int ti_write(struct tty_struct *tty, struct usb_serial_port *port, | 103 | static int ti_write(struct tty_struct *tty, struct usb_serial_port *port, |
105 | const unsigned char *data, int count); | 104 | const unsigned char *data, int count); |
@@ -492,8 +491,7 @@ static void ti_release(struct usb_serial *serial) | |||
492 | } | 491 | } |
493 | 492 | ||
494 | 493 | ||
495 | static int ti_open(struct tty_struct *tty, | 494 | static int ti_open(struct tty_struct *tty, struct usb_serial_port *port) |
496 | struct usb_serial_port *port, struct file *file) | ||
497 | { | 495 | { |
498 | struct ti_port *tport = usb_get_serial_port_data(port); | 496 | struct ti_port *tport = usb_get_serial_port_data(port); |
499 | struct ti_device *tdev; | 497 | struct ti_device *tdev; |
diff --git a/drivers/usb/serial/usb-serial.c b/drivers/usb/serial/usb-serial.c index 99188c92068b..9d7ca4868d37 100644 --- a/drivers/usb/serial/usb-serial.c +++ b/drivers/usb/serial/usb-serial.c | |||
@@ -43,8 +43,6 @@ | |||
43 | #define DRIVER_AUTHOR "Greg Kroah-Hartman, greg@kroah.com, http://www.kroah.com/linux/" | 43 | #define DRIVER_AUTHOR "Greg Kroah-Hartman, greg@kroah.com, http://www.kroah.com/linux/" |
44 | #define DRIVER_DESC "USB Serial Driver core" | 44 | #define DRIVER_DESC "USB Serial Driver core" |
45 | 45 | ||
46 | static void port_free(struct usb_serial_port *port); | ||
47 | |||
48 | /* Driver structure we register with the USB core */ | 46 | /* Driver structure we register with the USB core */ |
49 | static struct usb_driver usb_serial_driver = { | 47 | static struct usb_driver usb_serial_driver = { |
50 | .name = "usbserial", | 48 | .name = "usbserial", |
@@ -68,6 +66,11 @@ static struct usb_serial *serial_table[SERIAL_TTY_MINORS]; | |||
68 | static DEFINE_MUTEX(table_lock); | 66 | static DEFINE_MUTEX(table_lock); |
69 | static LIST_HEAD(usb_serial_driver_list); | 67 | static LIST_HEAD(usb_serial_driver_list); |
70 | 68 | ||
69 | /* | ||
70 | * Look up the serial structure. If it is found and it hasn't been | ||
71 | * disconnected, return with its disc_mutex held and its refcount | ||
72 | * incremented. Otherwise return NULL. | ||
73 | */ | ||
71 | struct usb_serial *usb_serial_get_by_index(unsigned index) | 74 | struct usb_serial *usb_serial_get_by_index(unsigned index) |
72 | { | 75 | { |
73 | struct usb_serial *serial; | 76 | struct usb_serial *serial; |
@@ -75,8 +78,15 @@ struct usb_serial *usb_serial_get_by_index(unsigned index) | |||
75 | mutex_lock(&table_lock); | 78 | mutex_lock(&table_lock); |
76 | serial = serial_table[index]; | 79 | serial = serial_table[index]; |
77 | 80 | ||
78 | if (serial) | 81 | if (serial) { |
79 | kref_get(&serial->kref); | 82 | mutex_lock(&serial->disc_mutex); |
83 | if (serial->disconnected) { | ||
84 | mutex_unlock(&serial->disc_mutex); | ||
85 | serial = NULL; | ||
86 | } else { | ||
87 | kref_get(&serial->kref); | ||
88 | } | ||
89 | } | ||
80 | mutex_unlock(&table_lock); | 90 | mutex_unlock(&table_lock); |
81 | return serial; | 91 | return serial; |
82 | } | 92 | } |
@@ -125,8 +135,10 @@ static void return_serial(struct usb_serial *serial) | |||
125 | 135 | ||
126 | dbg("%s", __func__); | 136 | dbg("%s", __func__); |
127 | 137 | ||
138 | mutex_lock(&table_lock); | ||
128 | for (i = 0; i < serial->num_ports; ++i) | 139 | for (i = 0; i < serial->num_ports; ++i) |
129 | serial_table[serial->minor + i] = NULL; | 140 | serial_table[serial->minor + i] = NULL; |
141 | mutex_unlock(&table_lock); | ||
130 | } | 142 | } |
131 | 143 | ||
132 | static void destroy_serial(struct kref *kref) | 144 | static void destroy_serial(struct kref *kref) |
@@ -145,161 +157,157 @@ static void destroy_serial(struct kref *kref) | |||
145 | 157 | ||
146 | serial->type->release(serial); | 158 | serial->type->release(serial); |
147 | 159 | ||
148 | for (i = 0; i < serial->num_ports; ++i) { | 160 | /* Now that nothing is using the ports, they can be freed */ |
161 | for (i = 0; i < serial->num_port_pointers; ++i) { | ||
149 | port = serial->port[i]; | 162 | port = serial->port[i]; |
150 | if (port) | 163 | if (port) { |
164 | port->serial = NULL; | ||
151 | put_device(&port->dev); | 165 | put_device(&port->dev); |
152 | } | ||
153 | |||
154 | /* If this is a "fake" port, we have to clean it up here, as it will | ||
155 | * not get cleaned up in port_release() as it was never registered with | ||
156 | * the driver core */ | ||
157 | if (serial->num_ports < serial->num_port_pointers) { | ||
158 | for (i = serial->num_ports; | ||
159 | i < serial->num_port_pointers; ++i) { | ||
160 | port = serial->port[i]; | ||
161 | if (port) | ||
162 | port_free(port); | ||
163 | } | 166 | } |
164 | } | 167 | } |
165 | 168 | ||
166 | usb_put_dev(serial->dev); | 169 | usb_put_dev(serial->dev); |
167 | |||
168 | /* free up any memory that we allocated */ | ||
169 | kfree(serial); | 170 | kfree(serial); |
170 | } | 171 | } |
171 | 172 | ||
172 | void usb_serial_put(struct usb_serial *serial) | 173 | void usb_serial_put(struct usb_serial *serial) |
173 | { | 174 | { |
174 | mutex_lock(&table_lock); | ||
175 | kref_put(&serial->kref, destroy_serial); | 175 | kref_put(&serial->kref, destroy_serial); |
176 | mutex_unlock(&table_lock); | ||
177 | } | 176 | } |
178 | 177 | ||
179 | /***************************************************************************** | 178 | /***************************************************************************** |
180 | * Driver tty interface functions | 179 | * Driver tty interface functions |
181 | *****************************************************************************/ | 180 | *****************************************************************************/ |
182 | static int serial_open (struct tty_struct *tty, struct file *filp) | 181 | |
182 | /** | ||
183 | * serial_install - install tty | ||
184 | * @driver: the driver (USB in our case) | ||
185 | * @tty: the tty being created | ||
186 | * | ||
187 | * Create the termios objects for this tty. We use the default | ||
188 | * USB serial settings but permit them to be overridden by | ||
189 | * serial->type->init_termios. | ||
190 | * | ||
191 | * This is the first place a new tty gets used. Hence this is where we | ||
192 | * acquire references to the usb_serial structure and the driver module, | ||
193 | * where we store a pointer to the port, and where we do an autoresume. | ||
194 | * All these actions are reversed in serial_release(). | ||
195 | */ | ||
196 | static int serial_install(struct tty_driver *driver, struct tty_struct *tty) | ||
183 | { | 197 | { |
198 | int idx = tty->index; | ||
184 | struct usb_serial *serial; | 199 | struct usb_serial *serial; |
185 | struct usb_serial_port *port; | 200 | struct usb_serial_port *port; |
186 | unsigned int portNumber; | 201 | int retval = -ENODEV; |
187 | int retval = 0; | ||
188 | int first = 0; | ||
189 | 202 | ||
190 | dbg("%s", __func__); | 203 | dbg("%s", __func__); |
191 | 204 | ||
192 | /* get the serial object associated with this tty pointer */ | 205 | serial = usb_serial_get_by_index(idx); |
193 | serial = usb_serial_get_by_index(tty->index); | 206 | if (!serial) |
194 | if (!serial) { | 207 | return retval; |
195 | tty->driver_data = NULL; | ||
196 | return -ENODEV; | ||
197 | } | ||
198 | 208 | ||
199 | mutex_lock(&serial->disc_mutex); | 209 | port = serial->port[idx - serial->minor]; |
200 | portNumber = tty->index - serial->minor; | 210 | if (!port) |
201 | port = serial->port[portNumber]; | 211 | goto error_no_port; |
202 | if (!port || serial->disconnected) | 212 | if (!try_module_get(serial->type->driver.owner)) |
203 | retval = -ENODEV; | 213 | goto error_module_get; |
204 | else | 214 | |
205 | get_device(&port->dev); | 215 | /* perform the standard setup */ |
206 | /* | 216 | retval = tty_init_termios(tty); |
207 | * Note: Our locking order requirement does not allow port->mutex | ||
208 | * to be acquired while serial->disc_mutex is held. | ||
209 | */ | ||
210 | mutex_unlock(&serial->disc_mutex); | ||
211 | if (retval) | 217 | if (retval) |
212 | goto bailout_serial_put; | 218 | goto error_init_termios; |
213 | 219 | ||
214 | if (mutex_lock_interruptible(&port->mutex)) { | 220 | retval = usb_autopm_get_interface(serial->interface); |
215 | retval = -ERESTARTSYS; | 221 | if (retval) |
216 | goto bailout_port_put; | 222 | goto error_get_interface; |
217 | } | 223 | |
224 | mutex_unlock(&serial->disc_mutex); | ||
218 | 225 | ||
219 | ++port->port.count; | 226 | /* allow the driver to update the settings */ |
227 | if (serial->type->init_termios) | ||
228 | serial->type->init_termios(tty); | ||
220 | 229 | ||
221 | /* set up our port structure making the tty driver | ||
222 | * remember our port object, and us it */ | ||
223 | tty->driver_data = port; | 230 | tty->driver_data = port; |
224 | tty_port_tty_set(&port->port, tty); | ||
225 | 231 | ||
226 | /* If the console is attached, the device is already open */ | 232 | /* Final install (we use the default method) */ |
227 | if (port->port.count == 1 && !port->console) { | 233 | tty_driver_kref_get(driver); |
228 | first = 1; | 234 | tty->count++; |
229 | /* lock this module before we call it | 235 | driver->ttys[idx] = tty; |
230 | * this may fail, which means we must bail out, | 236 | return retval; |
231 | * safe because we are called with BKL held */ | ||
232 | if (!try_module_get(serial->type->driver.owner)) { | ||
233 | retval = -ENODEV; | ||
234 | goto bailout_mutex_unlock; | ||
235 | } | ||
236 | 237 | ||
238 | error_get_interface: | ||
239 | error_init_termios: | ||
240 | module_put(serial->type->driver.owner); | ||
241 | error_module_get: | ||
242 | error_no_port: | ||
243 | usb_serial_put(serial); | ||
244 | mutex_unlock(&serial->disc_mutex); | ||
245 | return retval; | ||
246 | } | ||
247 | |||
248 | static int serial_open(struct tty_struct *tty, struct file *filp) | ||
249 | { | ||
250 | struct usb_serial_port *port = tty->driver_data; | ||
251 | struct usb_serial *serial = port->serial; | ||
252 | int retval; | ||
253 | |||
254 | dbg("%s - port %d", __func__, port->number); | ||
255 | |||
256 | spin_lock_irq(&port->port.lock); | ||
257 | if (!tty_hung_up_p(filp)) | ||
258 | ++port->port.count; | ||
259 | spin_unlock_irq(&port->port.lock); | ||
260 | tty_port_tty_set(&port->port, tty); | ||
261 | |||
262 | /* Do the device-specific open only if the hardware isn't | ||
263 | * already initialized. | ||
264 | */ | ||
265 | if (!test_bit(ASYNCB_INITIALIZED, &port->port.flags)) { | ||
266 | if (mutex_lock_interruptible(&port->mutex)) | ||
267 | return -ERESTARTSYS; | ||
237 | mutex_lock(&serial->disc_mutex); | 268 | mutex_lock(&serial->disc_mutex); |
238 | if (serial->disconnected) | 269 | if (serial->disconnected) |
239 | retval = -ENODEV; | 270 | retval = -ENODEV; |
240 | else | 271 | else |
241 | retval = usb_autopm_get_interface(serial->interface); | 272 | retval = port->serial->type->open(tty, port); |
242 | if (retval) | ||
243 | goto bailout_module_put; | ||
244 | |||
245 | /* only call the device specific open if this | ||
246 | * is the first time the port is opened */ | ||
247 | retval = serial->type->open(tty, port, filp); | ||
248 | if (retval) | ||
249 | goto bailout_interface_put; | ||
250 | mutex_unlock(&serial->disc_mutex); | 273 | mutex_unlock(&serial->disc_mutex); |
274 | mutex_unlock(&port->mutex); | ||
275 | if (retval) | ||
276 | return retval; | ||
251 | set_bit(ASYNCB_INITIALIZED, &port->port.flags); | 277 | set_bit(ASYNCB_INITIALIZED, &port->port.flags); |
252 | } | 278 | } |
253 | mutex_unlock(&port->mutex); | 279 | |
254 | /* Now do the correct tty layer semantics */ | 280 | /* Now do the correct tty layer semantics */ |
255 | retval = tty_port_block_til_ready(&port->port, tty, filp); | 281 | retval = tty_port_block_til_ready(&port->port, tty, filp); |
256 | if (retval == 0) { | ||
257 | if (!first) | ||
258 | usb_serial_put(serial); | ||
259 | return 0; | ||
260 | } | ||
261 | mutex_lock(&port->mutex); | ||
262 | if (first == 0) | ||
263 | goto bailout_mutex_unlock; | ||
264 | /* Undo the initial port actions */ | ||
265 | mutex_lock(&serial->disc_mutex); | ||
266 | bailout_interface_put: | ||
267 | usb_autopm_put_interface(serial->interface); | ||
268 | bailout_module_put: | ||
269 | mutex_unlock(&serial->disc_mutex); | ||
270 | module_put(serial->type->driver.owner); | ||
271 | bailout_mutex_unlock: | ||
272 | port->port.count = 0; | ||
273 | tty->driver_data = NULL; | ||
274 | tty_port_tty_set(&port->port, NULL); | ||
275 | mutex_unlock(&port->mutex); | ||
276 | bailout_port_put: | ||
277 | put_device(&port->dev); | ||
278 | bailout_serial_put: | ||
279 | usb_serial_put(serial); | ||
280 | return retval; | 282 | return retval; |
281 | } | 283 | } |
282 | 284 | ||
283 | /** | 285 | /** |
284 | * serial_do_down - shut down hardware | 286 | * serial_down - shut down hardware |
285 | * @port: port to shut down | 287 | * @port: port to shut down |
286 | * | ||
287 | * Shut down a USB port unless it is the console. We never shut down the | ||
288 | * console hardware as it will always be in use. | ||
289 | * | 288 | * |
290 | * Don't free any resources at this point | 289 | * Shut down a USB serial port unless it is the console. We never |
290 | * shut down the console hardware as it will always be in use. | ||
291 | */ | 291 | */ |
292 | static void serial_do_down(struct usb_serial_port *port) | 292 | static void serial_down(struct usb_serial_port *port) |
293 | { | 293 | { |
294 | struct usb_serial_driver *drv = port->serial->type; | 294 | struct usb_serial_driver *drv = port->serial->type; |
295 | struct usb_serial *serial; | 295 | struct usb_serial *serial; |
296 | struct module *owner; | 296 | struct module *owner; |
297 | 297 | ||
298 | /* The console is magical, do not hang up the console hardware | 298 | /* |
299 | or there will be tears */ | 299 | * The console is magical. Do not hang up the console hardware |
300 | * or there will be tears. | ||
301 | */ | ||
300 | if (port->console) | 302 | if (port->console) |
301 | return; | 303 | return; |
302 | 304 | ||
305 | /* Don't call the close method if the hardware hasn't been | ||
306 | * initialized. | ||
307 | */ | ||
308 | if (!test_and_clear_bit(ASYNCB_INITIALIZED, &port->port.flags)) | ||
309 | return; | ||
310 | |||
303 | mutex_lock(&port->mutex); | 311 | mutex_lock(&port->mutex); |
304 | serial = port->serial; | 312 | serial = port->serial; |
305 | owner = serial->type->driver.owner; | 313 | owner = serial->type->driver.owner; |
@@ -310,79 +318,69 @@ static void serial_do_down(struct usb_serial_port *port) | |||
310 | mutex_unlock(&port->mutex); | 318 | mutex_unlock(&port->mutex); |
311 | } | 319 | } |
312 | 320 | ||
313 | /** | 321 | static void serial_hangup(struct tty_struct *tty) |
314 | * serial_do_free - free resources post close/hangup | ||
315 | * @port: port to free up | ||
316 | * | ||
317 | * Do the resource freeing and refcount dropping for the port. We must | ||
318 | * be careful about ordering and we must avoid freeing up the console. | ||
319 | */ | ||
320 | |||
321 | static void serial_do_free(struct usb_serial_port *port) | ||
322 | { | 322 | { |
323 | struct usb_serial *serial; | 323 | struct usb_serial_port *port = tty->driver_data; |
324 | struct module *owner; | ||
325 | 324 | ||
326 | /* The console is magical, do not hang up the console hardware | 325 | dbg("%s - port %d", __func__, port->number); |
327 | or there will be tears */ | ||
328 | if (port->console) | ||
329 | return; | ||
330 | 326 | ||
331 | serial = port->serial; | 327 | serial_down(port); |
332 | owner = serial->type->driver.owner; | 328 | tty_port_hangup(&port->port); |
333 | put_device(&port->dev); | ||
334 | /* Mustn't dereference port any more */ | ||
335 | mutex_lock(&serial->disc_mutex); | ||
336 | if (!serial->disconnected) | ||
337 | usb_autopm_put_interface(serial->interface); | ||
338 | mutex_unlock(&serial->disc_mutex); | ||
339 | usb_serial_put(serial); | ||
340 | /* Mustn't dereference serial any more */ | ||
341 | module_put(owner); | ||
342 | } | 329 | } |
343 | 330 | ||
344 | static void serial_close(struct tty_struct *tty, struct file *filp) | 331 | static void serial_close(struct tty_struct *tty, struct file *filp) |
345 | { | 332 | { |
346 | struct usb_serial_port *port = tty->driver_data; | 333 | struct usb_serial_port *port = tty->driver_data; |
347 | 334 | ||
348 | if (!port) | ||
349 | return; | ||
350 | |||
351 | dbg("%s - port %d", __func__, port->number); | 335 | dbg("%s - port %d", __func__, port->number); |
352 | 336 | ||
353 | /* FIXME: | 337 | if (tty_hung_up_p(filp)) |
354 | This leaves a very narrow race. Really we should do the | ||
355 | serial_do_free() on tty->shutdown(), but tty->shutdown can | ||
356 | be called from IRQ context and serial_do_free can sleep. | ||
357 | |||
358 | The right fix is probably to make the tty free (which is rare) | ||
359 | and thus tty->shutdown() occur via a work queue and simplify all | ||
360 | the drivers that use it. | ||
361 | */ | ||
362 | if (tty_hung_up_p(filp)) { | ||
363 | /* serial_hangup already called serial_down at this point. | ||
364 | Another user may have already reopened the port but | ||
365 | serial_do_free is refcounted */ | ||
366 | serial_do_free(port); | ||
367 | return; | 338 | return; |
368 | } | ||
369 | |||
370 | if (tty_port_close_start(&port->port, tty, filp) == 0) | 339 | if (tty_port_close_start(&port->port, tty, filp) == 0) |
371 | return; | 340 | return; |
372 | 341 | serial_down(port); | |
373 | serial_do_down(port); | ||
374 | tty_port_close_end(&port->port, tty); | 342 | tty_port_close_end(&port->port, tty); |
375 | tty_port_tty_set(&port->port, NULL); | 343 | tty_port_tty_set(&port->port, NULL); |
376 | serial_do_free(port); | ||
377 | } | 344 | } |
378 | 345 | ||
379 | static void serial_hangup(struct tty_struct *tty) | 346 | /** |
347 | * serial_release - free resources post close/hangup | ||
348 | * @port: port to free up | ||
349 | * | ||
350 | * Do the resource freeing and refcount dropping for the port. | ||
351 | * Avoid freeing the console. | ||
352 | * | ||
353 | * Called when the last tty kref is dropped. | ||
354 | */ | ||
355 | static void serial_release(struct tty_struct *tty) | ||
380 | { | 356 | { |
381 | struct usb_serial_port *port = tty->driver_data; | 357 | struct usb_serial_port *port = tty->driver_data; |
382 | serial_do_down(port); | 358 | struct usb_serial *serial; |
383 | tty_port_hangup(&port->port); | 359 | struct module *owner; |
384 | /* We must not free port yet - the USB serial layer depends on it's | 360 | |
385 | continued existence */ | 361 | /* The console is magical. Do not hang up the console hardware |
362 | * or there will be tears. | ||
363 | */ | ||
364 | if (port->console) | ||
365 | return; | ||
366 | |||
367 | dbg("%s - port %d", __func__, port->number); | ||
368 | |||
369 | /* Standard shutdown processing */ | ||
370 | tty_shutdown(tty); | ||
371 | |||
372 | tty->driver_data = NULL; | ||
373 | |||
374 | serial = port->serial; | ||
375 | owner = serial->type->driver.owner; | ||
376 | |||
377 | mutex_lock(&serial->disc_mutex); | ||
378 | if (!serial->disconnected) | ||
379 | usb_autopm_put_interface(serial->interface); | ||
380 | mutex_unlock(&serial->disc_mutex); | ||
381 | |||
382 | usb_serial_put(serial); | ||
383 | module_put(owner); | ||
386 | } | 384 | } |
387 | 385 | ||
388 | static int serial_write(struct tty_struct *tty, const unsigned char *buf, | 386 | static int serial_write(struct tty_struct *tty, const unsigned char *buf, |
@@ -527,6 +525,7 @@ static int serial_proc_show(struct seq_file *m, void *v) | |||
527 | 525 | ||
528 | seq_putc(m, '\n'); | 526 | seq_putc(m, '\n'); |
529 | usb_serial_put(serial); | 527 | usb_serial_put(serial); |
528 | mutex_unlock(&serial->disc_mutex); | ||
530 | } | 529 | } |
531 | return 0; | 530 | return 0; |
532 | } | 531 | } |
@@ -596,14 +595,6 @@ static void usb_serial_port_work(struct work_struct *work) | |||
596 | tty_kref_put(tty); | 595 | tty_kref_put(tty); |
597 | } | 596 | } |
598 | 597 | ||
599 | static void port_release(struct device *dev) | ||
600 | { | ||
601 | struct usb_serial_port *port = to_usb_serial_port(dev); | ||
602 | |||
603 | dbg ("%s - %s", __func__, dev_name(dev)); | ||
604 | port_free(port); | ||
605 | } | ||
606 | |||
607 | static void kill_traffic(struct usb_serial_port *port) | 598 | static void kill_traffic(struct usb_serial_port *port) |
608 | { | 599 | { |
609 | usb_kill_urb(port->read_urb); | 600 | usb_kill_urb(port->read_urb); |
@@ -623,8 +614,12 @@ static void kill_traffic(struct usb_serial_port *port) | |||
623 | usb_kill_urb(port->interrupt_out_urb); | 614 | usb_kill_urb(port->interrupt_out_urb); |
624 | } | 615 | } |
625 | 616 | ||
626 | static void port_free(struct usb_serial_port *port) | 617 | static void port_release(struct device *dev) |
627 | { | 618 | { |
619 | struct usb_serial_port *port = to_usb_serial_port(dev); | ||
620 | |||
621 | dbg ("%s - %s", __func__, dev_name(dev)); | ||
622 | |||
628 | /* | 623 | /* |
629 | * Stop all the traffic before cancelling the work, so that | 624 | * Stop all the traffic before cancelling the work, so that |
630 | * nobody will restart it by calling usb_serial_port_softint. | 625 | * nobody will restart it by calling usb_serial_port_softint. |
@@ -935,6 +930,11 @@ int usb_serial_probe(struct usb_interface *interface, | |||
935 | mutex_init(&port->mutex); | 930 | mutex_init(&port->mutex); |
936 | INIT_WORK(&port->work, usb_serial_port_work); | 931 | INIT_WORK(&port->work, usb_serial_port_work); |
937 | serial->port[i] = port; | 932 | serial->port[i] = port; |
933 | port->dev.parent = &interface->dev; | ||
934 | port->dev.driver = NULL; | ||
935 | port->dev.bus = &usb_serial_bus_type; | ||
936 | port->dev.release = &port_release; | ||
937 | device_initialize(&port->dev); | ||
938 | } | 938 | } |
939 | 939 | ||
940 | /* set up the endpoint information */ | 940 | /* set up the endpoint information */ |
@@ -1077,15 +1077,10 @@ int usb_serial_probe(struct usb_interface *interface, | |||
1077 | /* register all of the individual ports with the driver core */ | 1077 | /* register all of the individual ports with the driver core */ |
1078 | for (i = 0; i < num_ports; ++i) { | 1078 | for (i = 0; i < num_ports; ++i) { |
1079 | port = serial->port[i]; | 1079 | port = serial->port[i]; |
1080 | port->dev.parent = &interface->dev; | ||
1081 | port->dev.driver = NULL; | ||
1082 | port->dev.bus = &usb_serial_bus_type; | ||
1083 | port->dev.release = &port_release; | ||
1084 | |||
1085 | dev_set_name(&port->dev, "ttyUSB%d", port->number); | 1080 | dev_set_name(&port->dev, "ttyUSB%d", port->number); |
1086 | dbg ("%s - registering %s", __func__, dev_name(&port->dev)); | 1081 | dbg ("%s - registering %s", __func__, dev_name(&port->dev)); |
1087 | port->dev_state = PORT_REGISTERING; | 1082 | port->dev_state = PORT_REGISTERING; |
1088 | retval = device_register(&port->dev); | 1083 | retval = device_add(&port->dev); |
1089 | if (retval) { | 1084 | if (retval) { |
1090 | dev_err(&port->dev, "Error registering port device, " | 1085 | dev_err(&port->dev, "Error registering port device, " |
1091 | "continuing\n"); | 1086 | "continuing\n"); |
@@ -1103,39 +1098,7 @@ exit: | |||
1103 | return 0; | 1098 | return 0; |
1104 | 1099 | ||
1105 | probe_error: | 1100 | probe_error: |
1106 | for (i = 0; i < num_bulk_in; ++i) { | 1101 | usb_serial_put(serial); |
1107 | port = serial->port[i]; | ||
1108 | if (!port) | ||
1109 | continue; | ||
1110 | usb_free_urb(port->read_urb); | ||
1111 | kfree(port->bulk_in_buffer); | ||
1112 | } | ||
1113 | for (i = 0; i < num_bulk_out; ++i) { | ||
1114 | port = serial->port[i]; | ||
1115 | if (!port) | ||
1116 | continue; | ||
1117 | usb_free_urb(port->write_urb); | ||
1118 | kfree(port->bulk_out_buffer); | ||
1119 | } | ||
1120 | for (i = 0; i < num_interrupt_in; ++i) { | ||
1121 | port = serial->port[i]; | ||
1122 | if (!port) | ||
1123 | continue; | ||
1124 | usb_free_urb(port->interrupt_in_urb); | ||
1125 | kfree(port->interrupt_in_buffer); | ||
1126 | } | ||
1127 | for (i = 0; i < num_interrupt_out; ++i) { | ||
1128 | port = serial->port[i]; | ||
1129 | if (!port) | ||
1130 | continue; | ||
1131 | usb_free_urb(port->interrupt_out_urb); | ||
1132 | kfree(port->interrupt_out_buffer); | ||
1133 | } | ||
1134 | |||
1135 | /* free up any memory that we allocated */ | ||
1136 | for (i = 0; i < serial->num_port_pointers; ++i) | ||
1137 | kfree(serial->port[i]); | ||
1138 | kfree(serial); | ||
1139 | return -EIO; | 1102 | return -EIO; |
1140 | } | 1103 | } |
1141 | EXPORT_SYMBOL_GPL(usb_serial_probe); | 1104 | EXPORT_SYMBOL_GPL(usb_serial_probe); |
@@ -1161,10 +1124,7 @@ void usb_serial_disconnect(struct usb_interface *interface) | |||
1161 | if (port) { | 1124 | if (port) { |
1162 | struct tty_struct *tty = tty_port_tty_get(&port->port); | 1125 | struct tty_struct *tty = tty_port_tty_get(&port->port); |
1163 | if (tty) { | 1126 | if (tty) { |
1164 | /* The hangup will occur asynchronously but | 1127 | tty_vhangup(tty); |
1165 | the object refcounts will sort out all the | ||
1166 | cleanup */ | ||
1167 | tty_hangup(tty); | ||
1168 | tty_kref_put(tty); | 1128 | tty_kref_put(tty); |
1169 | } | 1129 | } |
1170 | kill_traffic(port); | 1130 | kill_traffic(port); |
@@ -1189,8 +1149,7 @@ void usb_serial_disconnect(struct usb_interface *interface) | |||
1189 | } | 1149 | } |
1190 | serial->type->disconnect(serial); | 1150 | serial->type->disconnect(serial); |
1191 | 1151 | ||
1192 | /* let the last holder of this object | 1152 | /* let the last holder of this object cause it to be cleaned up */ |
1193 | * cause it to be cleaned up */ | ||
1194 | usb_serial_put(serial); | 1153 | usb_serial_put(serial); |
1195 | dev_info(dev, "device disconnected\n"); | 1154 | dev_info(dev, "device disconnected\n"); |
1196 | } | 1155 | } |
@@ -1246,6 +1205,8 @@ static const struct tty_operations serial_ops = { | |||
1246 | .chars_in_buffer = serial_chars_in_buffer, | 1205 | .chars_in_buffer = serial_chars_in_buffer, |
1247 | .tiocmget = serial_tiocmget, | 1206 | .tiocmget = serial_tiocmget, |
1248 | .tiocmset = serial_tiocmset, | 1207 | .tiocmset = serial_tiocmset, |
1208 | .shutdown = serial_release, | ||
1209 | .install = serial_install, | ||
1249 | .proc_fops = &serial_proc_fops, | 1210 | .proc_fops = &serial_proc_fops, |
1250 | }; | 1211 | }; |
1251 | 1212 | ||
diff --git a/drivers/usb/serial/usb_debug.c b/drivers/usb/serial/usb_debug.c index 614800972dc3..7b5bfc4edd3d 100644 --- a/drivers/usb/serial/usb_debug.c +++ b/drivers/usb/serial/usb_debug.c | |||
@@ -43,11 +43,10 @@ static struct usb_driver debug_driver = { | |||
43 | .no_dynamic_id = 1, | 43 | .no_dynamic_id = 1, |
44 | }; | 44 | }; |
45 | 45 | ||
46 | static int usb_debug_open(struct tty_struct *tty, struct usb_serial_port *port, | 46 | static int usb_debug_open(struct tty_struct *tty, struct usb_serial_port *port) |
47 | struct file *filp) | ||
48 | { | 47 | { |
49 | port->bulk_out_size = USB_DEBUG_MAX_PACKET_SIZE; | 48 | port->bulk_out_size = USB_DEBUG_MAX_PACKET_SIZE; |
50 | return usb_serial_generic_open(tty, port, filp); | 49 | return usb_serial_generic_open(tty, port); |
51 | } | 50 | } |
52 | 51 | ||
53 | /* This HW really does not support a serial break, so one will be | 52 | /* This HW really does not support a serial break, so one will be |
diff --git a/drivers/usb/serial/visor.c b/drivers/usb/serial/visor.c index f5d0f64dcc52..1aa5d20a5d99 100644 --- a/drivers/usb/serial/visor.c +++ b/drivers/usb/serial/visor.c | |||
@@ -36,8 +36,7 @@ | |||
36 | #define DRIVER_DESC "USB HandSpring Visor / Palm OS driver" | 36 | #define DRIVER_DESC "USB HandSpring Visor / Palm OS driver" |
37 | 37 | ||
38 | /* function prototypes for a handspring visor */ | 38 | /* function prototypes for a handspring visor */ |
39 | static int visor_open(struct tty_struct *tty, struct usb_serial_port *port, | 39 | static int visor_open(struct tty_struct *tty, struct usb_serial_port *port); |
40 | struct file *filp); | ||
41 | static void visor_close(struct usb_serial_port *port); | 40 | static void visor_close(struct usb_serial_port *port); |
42 | static int visor_write(struct tty_struct *tty, struct usb_serial_port *port, | 41 | static int visor_write(struct tty_struct *tty, struct usb_serial_port *port, |
43 | const unsigned char *buf, int count); | 42 | const unsigned char *buf, int count); |
@@ -273,8 +272,7 @@ static int stats; | |||
273 | /****************************************************************************** | 272 | /****************************************************************************** |
274 | * Handspring Visor specific driver functions | 273 | * Handspring Visor specific driver functions |
275 | ******************************************************************************/ | 274 | ******************************************************************************/ |
276 | static int visor_open(struct tty_struct *tty, struct usb_serial_port *port, | 275 | static int visor_open(struct tty_struct *tty, struct usb_serial_port *port) |
277 | struct file *filp) | ||
278 | { | 276 | { |
279 | struct usb_serial *serial = port->serial; | 277 | struct usb_serial *serial = port->serial; |
280 | struct visor_private *priv = usb_get_serial_port_data(port); | 278 | struct visor_private *priv = usb_get_serial_port_data(port); |
diff --git a/drivers/usb/serial/whiteheat.c b/drivers/usb/serial/whiteheat.c index 8d126dd7a02e..62424eec33ec 100644 --- a/drivers/usb/serial/whiteheat.c +++ b/drivers/usb/serial/whiteheat.c | |||
@@ -146,7 +146,7 @@ static int whiteheat_firmware_attach(struct usb_serial *serial); | |||
146 | static int whiteheat_attach(struct usb_serial *serial); | 146 | static int whiteheat_attach(struct usb_serial *serial); |
147 | static void whiteheat_release(struct usb_serial *serial); | 147 | static void whiteheat_release(struct usb_serial *serial); |
148 | static int whiteheat_open(struct tty_struct *tty, | 148 | static int whiteheat_open(struct tty_struct *tty, |
149 | struct usb_serial_port *port, struct file *filp); | 149 | struct usb_serial_port *port); |
150 | static void whiteheat_close(struct usb_serial_port *port); | 150 | static void whiteheat_close(struct usb_serial_port *port); |
151 | static int whiteheat_write(struct tty_struct *tty, | 151 | static int whiteheat_write(struct tty_struct *tty, |
152 | struct usb_serial_port *port, | 152 | struct usb_serial_port *port, |
@@ -259,7 +259,7 @@ static int firm_send_command(struct usb_serial_port *port, __u8 command, | |||
259 | __u8 *data, __u8 datasize); | 259 | __u8 *data, __u8 datasize); |
260 | static int firm_open(struct usb_serial_port *port); | 260 | static int firm_open(struct usb_serial_port *port); |
261 | static int firm_close(struct usb_serial_port *port); | 261 | static int firm_close(struct usb_serial_port *port); |
262 | static int firm_setup_port(struct tty_struct *tty); | 262 | static void firm_setup_port(struct tty_struct *tty); |
263 | static int firm_set_rts(struct usb_serial_port *port, __u8 onoff); | 263 | static int firm_set_rts(struct usb_serial_port *port, __u8 onoff); |
264 | static int firm_set_dtr(struct usb_serial_port *port, __u8 onoff); | 264 | static int firm_set_dtr(struct usb_serial_port *port, __u8 onoff); |
265 | static int firm_set_break(struct usb_serial_port *port, __u8 onoff); | 265 | static int firm_set_break(struct usb_serial_port *port, __u8 onoff); |
@@ -659,8 +659,7 @@ static void whiteheat_release(struct usb_serial *serial) | |||
659 | return; | 659 | return; |
660 | } | 660 | } |
661 | 661 | ||
662 | static int whiteheat_open(struct tty_struct *tty, | 662 | static int whiteheat_open(struct tty_struct *tty, struct usb_serial_port *port) |
663 | struct usb_serial_port *port, struct file *filp) | ||
664 | { | 663 | { |
665 | int retval = 0; | 664 | int retval = 0; |
666 | 665 | ||
@@ -1211,7 +1210,7 @@ static int firm_close(struct usb_serial_port *port) | |||
1211 | } | 1210 | } |
1212 | 1211 | ||
1213 | 1212 | ||
1214 | static int firm_setup_port(struct tty_struct *tty) | 1213 | static void firm_setup_port(struct tty_struct *tty) |
1215 | { | 1214 | { |
1216 | struct usb_serial_port *port = tty->driver_data; | 1215 | struct usb_serial_port *port = tty->driver_data; |
1217 | struct whiteheat_port_settings port_settings; | 1216 | struct whiteheat_port_settings port_settings; |
@@ -1286,7 +1285,7 @@ static int firm_setup_port(struct tty_struct *tty) | |||
1286 | port_settings.lloop = 0; | 1285 | port_settings.lloop = 0; |
1287 | 1286 | ||
1288 | /* now send the message to the device */ | 1287 | /* now send the message to the device */ |
1289 | return firm_send_command(port, WHITEHEAT_SETUP_PORT, | 1288 | firm_send_command(port, WHITEHEAT_SETUP_PORT, |
1290 | (__u8 *)&port_settings, sizeof(port_settings)); | 1289 | (__u8 *)&port_settings, sizeof(port_settings)); |
1291 | } | 1290 | } |
1292 | 1291 | ||