1
2
3
4
5
6
7
8#include <linux/delay.h>
9#include <linux/gpio.h>
10#include <linux/interrupt.h>
11#include <linux/io.h>
12#include <linux/ioport.h>
13#include <linux/mm.h>
14#include <linux/module.h>
15#include <linux/platform_device.h>
16#include <linux/pm.h>
17#include <linux/resource.h>
18#include <linux/slab.h>
19#include <linux/spinlock.h>
20
21#include <pcmcia/ss.h>
22#include <pcmcia/cistpl.h>
23
24#include <asm/irq.h>
25#include <asm/mach-au1x00/au1000.h>
26
27#define MEM_MAP_SIZE 0x400000
28#define IO_MAP_SIZE 0x1000
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43#define GPIO_CDA 0
44#define GPIO_CDB 1
45#define GPIO_CARDIRQ 4
46#define GPIO_RESET 204
47#define GPIO_OUTEN 205
48#define GPIO_VSL 208
49#define GPIO_VSH 209
50#define GPIO_BATTDEAD 210
51#define GPIO_BATTWARN 211
52#define GPIO_POWER 214
53
54struct xxs1500_pcmcia_sock {
55 struct pcmcia_socket socket;
56 void *virt_io;
57
58 phys_addr_t phys_io;
59 phys_addr_t phys_attr;
60 phys_addr_t phys_mem;
61
62
63 unsigned int old_flags;
64};
65
66#define to_xxs_socket(x) container_of(x, struct xxs1500_pcmcia_sock, socket)
67
68static irqreturn_t cdirq(int irq, void *data)
69{
70 struct xxs1500_pcmcia_sock *sock = data;
71
72 pcmcia_parse_events(&sock->socket, SS_DETECT);
73
74 return IRQ_HANDLED;
75}
76
77static int xxs1500_pcmcia_configure(struct pcmcia_socket *skt,
78 struct socket_state_t *state)
79{
80 struct xxs1500_pcmcia_sock *sock = to_xxs_socket(skt);
81 unsigned int changed;
82
83
84 switch (state->Vcc) {
85 case 0:
86 gpio_set_value(GPIO_POWER, 1);
87 break;
88 case 33:
89 gpio_set_value(GPIO_POWER, 0);
90 break;
91 case 50:
92 default:
93 return -EINVAL;
94 }
95
96 changed = state->flags ^ sock->old_flags;
97
98 if (changed & SS_RESET) {
99 if (state->flags & SS_RESET) {
100 gpio_set_value(GPIO_RESET, 1);
101 gpio_set_value(GPIO_OUTEN, 1);
102 } else {
103 gpio_set_value(GPIO_RESET, 0);
104 gpio_set_value(GPIO_OUTEN, 0);
105 msleep(500);
106 }
107 }
108
109 sock->old_flags = state->flags;
110
111 return 0;
112}
113
114static int xxs1500_pcmcia_get_status(struct pcmcia_socket *skt,
115 unsigned int *value)
116{
117 unsigned int status;
118 int i;
119
120 status = 0;
121
122
123 if (!gpio_get_value(GPIO_CDA) && !gpio_get_value(GPIO_CDB))
124 status |= SS_DETECT;
125
126
127 i = (!!gpio_get_value(GPIO_VSL)) | ((!!gpio_get_value(GPIO_VSH)) << 1);
128
129 switch (i) {
130 case 0:
131 case 1:
132 case 2:
133 status |= SS_3VCARD;
134 break;
135 case 3:
136 default:
137 status |= SS_XVCARD;
138 }
139
140
141 status |= gpio_get_value(GPIO_POWER) ? 0 : SS_POWERON;
142
143
144 status |= gpio_get_value(GPIO_RESET) ? SS_RESET : SS_READY;
145
146
147 status |= gpio_get_value(GPIO_BATTDEAD) ? 0 : SS_BATDEAD;
148 status |= gpio_get_value(GPIO_BATTWARN) ? 0 : SS_BATWARN;
149
150 *value = status;
151
152 return 0;
153}
154
155static int xxs1500_pcmcia_sock_init(struct pcmcia_socket *skt)
156{
157 gpio_direction_input(GPIO_CDA);
158 gpio_direction_input(GPIO_CDB);
159 gpio_direction_input(GPIO_VSL);
160 gpio_direction_input(GPIO_VSH);
161 gpio_direction_input(GPIO_BATTDEAD);
162 gpio_direction_input(GPIO_BATTWARN);
163 gpio_direction_output(GPIO_RESET, 1);
164 gpio_direction_output(GPIO_OUTEN, 1);
165 gpio_direction_output(GPIO_POWER, 1);
166
167 return 0;
168}
169
170static int xxs1500_pcmcia_sock_suspend(struct pcmcia_socket *skt)
171{
172 return 0;
173}
174
175static int au1x00_pcmcia_set_io_map(struct pcmcia_socket *skt,
176 struct pccard_io_map *map)
177{
178 struct xxs1500_pcmcia_sock *sock = to_xxs_socket(skt);
179
180 map->start = (u32)sock->virt_io;
181 map->stop = map->start + IO_MAP_SIZE;
182
183 return 0;
184}
185
186static int au1x00_pcmcia_set_mem_map(struct pcmcia_socket *skt,
187 struct pccard_mem_map *map)
188{
189 struct xxs1500_pcmcia_sock *sock = to_xxs_socket(skt);
190
191 if (map->flags & MAP_ATTRIB)
192 map->static_start = sock->phys_attr + map->card_start;
193 else
194 map->static_start = sock->phys_mem + map->card_start;
195
196 return 0;
197}
198
199static struct pccard_operations xxs1500_pcmcia_operations = {
200 .init = xxs1500_pcmcia_sock_init,
201 .suspend = xxs1500_pcmcia_sock_suspend,
202 .get_status = xxs1500_pcmcia_get_status,
203 .set_socket = xxs1500_pcmcia_configure,
204 .set_io_map = au1x00_pcmcia_set_io_map,
205 .set_mem_map = au1x00_pcmcia_set_mem_map,
206};
207
208static int xxs1500_pcmcia_probe(struct platform_device *pdev)
209{
210 struct xxs1500_pcmcia_sock *sock;
211 struct resource *r;
212 int ret, irq;
213
214 sock = kzalloc(sizeof(struct xxs1500_pcmcia_sock), GFP_KERNEL);
215 if (!sock)
216 return -ENOMEM;
217
218 ret = -ENODEV;
219
220
221 r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-attr");
222 if (!r) {
223 dev_err(&pdev->dev, "missing 'pcmcia-attr' resource!\n");
224 goto out0;
225 }
226 sock->phys_attr = r->start;
227
228
229 r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-mem");
230 if (!r) {
231 dev_err(&pdev->dev, "missing 'pcmcia-mem' resource!\n");
232 goto out0;
233 }
234 sock->phys_mem = r->start;
235
236
237 r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pcmcia-io");
238 if (!r) {
239 dev_err(&pdev->dev, "missing 'pcmcia-io' resource!\n");
240 goto out0;
241 }
242 sock->phys_io = r->start;
243
244
245
246
247
248
249
250
251
252
253 sock->virt_io = (void *)(ioremap(sock->phys_io, IO_MAP_SIZE) -
254 mips_io_port_base);
255
256 if (!sock->virt_io) {
257 dev_err(&pdev->dev, "cannot remap IO area\n");
258 ret = -ENOMEM;
259 goto out0;
260 }
261
262 sock->socket.ops = &xxs1500_pcmcia_operations;
263 sock->socket.owner = THIS_MODULE;
264 sock->socket.pci_irq = gpio_to_irq(GPIO_CARDIRQ);
265 sock->socket.features = SS_CAP_STATIC_MAP | SS_CAP_PCCARD;
266 sock->socket.map_size = MEM_MAP_SIZE;
267 sock->socket.io_offset = (unsigned long)sock->virt_io;
268 sock->socket.dev.parent = &pdev->dev;
269 sock->socket.resource_ops = &pccard_static_ops;
270
271 platform_set_drvdata(pdev, sock);
272
273
274
275
276 irq = gpio_to_irq(GPIO_CDA);
277 irq_set_irq_type(irq, IRQ_TYPE_EDGE_BOTH);
278 ret = request_irq(irq, cdirq, 0, "pcmcia_carddetect", sock);
279 if (ret) {
280 dev_err(&pdev->dev, "cannot setup cd irq\n");
281 goto out1;
282 }
283
284 ret = pcmcia_register_socket(&sock->socket);
285 if (ret) {
286 dev_err(&pdev->dev, "failed to register\n");
287 goto out2;
288 }
289
290 printk(KERN_INFO "MyCable XXS1500 PCMCIA socket services\n");
291
292 return 0;
293
294out2:
295 free_irq(gpio_to_irq(GPIO_CDA), sock);
296out1:
297 iounmap((void *)(sock->virt_io + (u32)mips_io_port_base));
298out0:
299 kfree(sock);
300 return ret;
301}
302
303static int xxs1500_pcmcia_remove(struct platform_device *pdev)
304{
305 struct xxs1500_pcmcia_sock *sock = platform_get_drvdata(pdev);
306
307 pcmcia_unregister_socket(&sock->socket);
308 free_irq(gpio_to_irq(GPIO_CDA), sock);
309 iounmap((void *)(sock->virt_io + (u32)mips_io_port_base));
310 kfree(sock);
311
312 return 0;
313}
314
315static struct platform_driver xxs1500_pcmcia_socket_driver = {
316 .driver = {
317 .name = "xxs1500_pcmcia",
318 },
319 .probe = xxs1500_pcmcia_probe,
320 .remove = xxs1500_pcmcia_remove,
321};
322
323module_platform_driver(xxs1500_pcmcia_socket_driver);
324
325MODULE_LICENSE("GPL");
326MODULE_DESCRIPTION("PCMCIA Socket Services for MyCable XXS1500 systems");
327MODULE_AUTHOR("Manuel Lauss");
328
