V4L/DVB (9689): gspca: Memory leak when disconnect while streaming.
[linux-2.6] / drivers / pcmcia / pxa2xx_cm_x255.c
1 /*
2  * linux/drivers/pcmcia/pxa/pxa_cm_x255.c
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  *
8  * Compulab Ltd., 2003, 2007, 2008
9  * Mike Rapoport <mike@compulab.co.il>
10  *
11  */
12
13 #include <linux/platform_device.h>
14 #include <linux/irq.h>
15 #include <linux/delay.h>
16 #include <linux/gpio.h>
17
18 #include <asm/mach-types.h>
19 #include <mach/pxa-regs.h>
20
21 #include "soc_common.h"
22
23 #define GPIO_PCMCIA_SKTSEL      (54)
24 #define GPIO_PCMCIA_S0_CD_VALID (16)
25 #define GPIO_PCMCIA_S1_CD_VALID (17)
26 #define GPIO_PCMCIA_S0_RDYINT   (6)
27 #define GPIO_PCMCIA_S1_RDYINT   (8)
28 #define GPIO_PCMCIA_RESET       (9)
29
30 #define PCMCIA_S0_CD_VALID      IRQ_GPIO(GPIO_PCMCIA_S0_CD_VALID)
31 #define PCMCIA_S1_CD_VALID      IRQ_GPIO(GPIO_PCMCIA_S1_CD_VALID)
32 #define PCMCIA_S0_RDYINT        IRQ_GPIO(GPIO_PCMCIA_S0_RDYINT)
33 #define PCMCIA_S1_RDYINT        IRQ_GPIO(GPIO_PCMCIA_S1_RDYINT)
34
35
36 static struct pcmcia_irqs irqs[] = {
37         { 0, PCMCIA_S0_CD_VALID, "PCMCIA0 CD" },
38         { 1, PCMCIA_S1_CD_VALID, "PCMCIA1 CD" },
39 };
40
41 static int cmx255_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
42 {
43         int ret = gpio_request(GPIO_PCMCIA_RESET, "PCCard reset");
44         if (ret)
45                 return ret;
46         gpio_direction_output(GPIO_PCMCIA_RESET, 0);
47
48         skt->irq = skt->nr == 0 ? PCMCIA_S0_RDYINT : PCMCIA_S1_RDYINT;
49         ret = soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
50         if (!ret)
51                 gpio_free(GPIO_PCMCIA_RESET);
52
53         return ret;
54 }
55
56 static void cmx255_pcmcia_shutdown(struct soc_pcmcia_socket *skt)
57 {
58         soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
59         gpio_free(GPIO_PCMCIA_RESET);
60 }
61
62
63 static void cmx255_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
64                                        struct pcmcia_state *state)
65 {
66         int cd = skt->nr ? GPIO_PCMCIA_S1_CD_VALID : GPIO_PCMCIA_S0_CD_VALID;
67         int rdy = skt->nr ? GPIO_PCMCIA_S0_RDYINT : GPIO_PCMCIA_S1_RDYINT;
68
69         state->detect = !gpio_get_value(cd);
70         state->ready  = !!gpio_get_value(rdy);
71         state->bvd1   = 1;
72         state->bvd2   = 1;
73         state->vs_3v  = 0;
74         state->vs_Xv  = 0;
75         state->wrprot = 0;  /* not available */
76 }
77
78
79 static int cmx255_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
80                                           const socket_state_t *state)
81 {
82         switch (skt->nr) {
83         case 0:
84                 if (state->flags & SS_RESET) {
85                         gpio_set_value(GPIO_PCMCIA_SKTSEL, 0);
86                         udelay(1);
87                         gpio_set_value(GPIO_PCMCIA_RESET, 1);
88                         udelay(10);
89                         gpio_set_value(GPIO_PCMCIA_RESET, 0);
90                 }
91                 break;
92         case 1:
93                 if (state->flags & SS_RESET) {
94                         gpio_set_value(GPIO_PCMCIA_SKTSEL, 1);
95                         udelay(1);
96                         gpio_set_value(GPIO_PCMCIA_RESET, 1);
97                         udelay(10);
98                         gpio_set_value(GPIO_PCMCIA_RESET, 0);
99                 }
100                 break;
101         }
102
103         return 0;
104 }
105
106 static void cmx255_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
107 {
108 }
109
110 static void cmx255_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
111 {
112 }
113
114
115 static struct pcmcia_low_level cmx255_pcmcia_ops __initdata = {
116         .owner                  = THIS_MODULE,
117         .hw_init                = cmx255_pcmcia_hw_init,
118         .hw_shutdown            = cmx255_pcmcia_shutdown,
119         .socket_state           = cmx255_pcmcia_socket_state,
120         .configure_socket       = cmx255_pcmcia_configure_socket,
121         .socket_init            = cmx255_pcmcia_socket_init,
122         .socket_suspend         = cmx255_pcmcia_socket_suspend,
123         .nr                     = 1,
124 };
125
126 static struct platform_device *cmx255_pcmcia_device;
127
128 int __init cmx255_pcmcia_init(void)
129 {
130         int ret;
131
132         cmx255_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
133
134         if (!cmx255_pcmcia_device)
135                 return -ENOMEM;
136
137         ret = platform_device_add_data(cmx255_pcmcia_device, &cmx255_pcmcia_ops,
138                                        sizeof(cmx255_pcmcia_ops));
139
140         if (ret == 0) {
141                 printk(KERN_INFO "Registering cm-x255 PCMCIA interface.\n");
142                 ret = platform_device_add(cmx255_pcmcia_device);
143         }
144
145         if (ret)
146                 platform_device_put(cmx255_pcmcia_device);
147
148         return ret;
149 }
150
151 void __exit cmx255_pcmcia_exit(void)
152 {
153         platform_device_unregister(cmx255_pcmcia_device);
154 }