1
2
3
4
5
6
7
8
9
10#include <linux/kernel.h>
11#include <linux/module.h>
12#include <linux/slab.h>
13#include <linux/pci.h>
14#include <linux/init.h>
15#include <linux/workqueue.h>
16#include <linux/interrupt.h>
17#include <linux/device.h>
18#include <linux/io.h>
19
20#include <pcmcia/cs_types.h>
21#include <pcmcia/ss.h>
22#include <pcmcia/cs.h>
23
24#include <asm/system.h>
25
26#include "pd6729.h"
27#include "i82365.h"
28#include "cirrus.h"
29
30MODULE_LICENSE("GPL");
31MODULE_DESCRIPTION("Driver for the Cirrus PD6729 PCI-PCMCIA bridge");
32MODULE_AUTHOR("Jun Komuro <komurojun-mbn@nifty.com>");
33
34#define MAX_SOCKETS 2
35
36
37
38
39
40#define to_cycles(ns) ((ns)/120)
41
42#ifndef NO_IRQ
43#define NO_IRQ ((unsigned int)(0))
44#endif
45
46
47
48
49
50
51
52
53
54static int irq_mode = 1;
55
56module_param(irq_mode, int, 0444);
57MODULE_PARM_DESC(irq_mode,
58 "interrupt delivery mode. 0 = ISA, 1 = PCI. default is 1");
59
60static DEFINE_SPINLOCK(port_lock);
61
62
63
64static unsigned char indirect_read(struct pd6729_socket *socket,
65 unsigned short reg)
66{
67 unsigned long port;
68 unsigned char val;
69 unsigned long flags;
70
71 spin_lock_irqsave(&port_lock, flags);
72 reg += socket->number * 0x40;
73 port = socket->io_base;
74 outb(reg, port);
75 val = inb(port + 1);
76 spin_unlock_irqrestore(&port_lock, flags);
77
78 return val;
79}
80
81static unsigned short indirect_read16(struct pd6729_socket *socket,
82 unsigned short reg)
83{
84 unsigned long port;
85 unsigned short tmp;
86 unsigned long flags;
87
88 spin_lock_irqsave(&port_lock, flags);
89 reg = reg + socket->number * 0x40;
90 port = socket->io_base;
91 outb(reg, port);
92 tmp = inb(port + 1);
93 reg++;
94 outb(reg, port);
95 tmp = tmp | (inb(port + 1) << 8);
96 spin_unlock_irqrestore(&port_lock, flags);
97
98 return tmp;
99}
100
101static void indirect_write(struct pd6729_socket *socket, unsigned short reg,
102 unsigned char value)
103{
104 unsigned long port;
105 unsigned long flags;
106
107 spin_lock_irqsave(&port_lock, flags);
108 reg = reg + socket->number * 0x40;
109 port = socket->io_base;
110 outb(reg, port);
111 outb(value, port + 1);
112 spin_unlock_irqrestore(&port_lock, flags);
113}
114
115static void indirect_setbit(struct pd6729_socket *socket, unsigned short reg,
116 unsigned char mask)
117{
118 unsigned long port;
119 unsigned char val;
120 unsigned long flags;
121
122 spin_lock_irqsave(&port_lock, flags);
123 reg = reg + socket->number * 0x40;
124 port = socket->io_base;
125 outb(reg, port);
126 val = inb(port + 1);
127 val |= mask;
128 outb(reg, port);
129 outb(val, port + 1);
130 spin_unlock_irqrestore(&port_lock, flags);
131}
132
133static void indirect_resetbit(struct pd6729_socket *socket, unsigned short reg,
134 unsigned char mask)
135{
136 unsigned long port;
137 unsigned char val;
138 unsigned long flags;
139
140 spin_lock_irqsave(&port_lock, flags);
141 reg = reg + socket->number * 0x40;
142 port = socket->io_base;
143 outb(reg, port);
144 val = inb(port + 1);
145 val &= ~mask;
146 outb(reg, port);
147 outb(val, port + 1);
148 spin_unlock_irqrestore(&port_lock, flags);
149}
150
151static void indirect_write16(struct pd6729_socket *socket, unsigned short reg,
152 unsigned short value)
153{
154 unsigned long port;
155 unsigned char val;
156 unsigned long flags;
157
158 spin_lock_irqsave(&port_lock, flags);
159 reg = reg + socket->number * 0x40;
160 port = socket->io_base;
161
162 outb(reg, port);
163 val = value & 255;
164 outb(val, port + 1);
165
166 reg++;
167
168 outb(reg, port);
169 val = value >> 8;
170 outb(val, port + 1);
171 spin_unlock_irqrestore(&port_lock, flags);
172}
173
174
175
176static irqreturn_t pd6729_interrupt(int irq, void *dev)
177{
178 struct pd6729_socket *socket = (struct pd6729_socket *)dev;
179 int i;
180 int loopcount = 0;
181 int handled = 0;
182 unsigned int events, active = 0;
183
184 while (1) {
185 loopcount++;
186 if (loopcount > 20) {
187 printk(KERN_ERR "pd6729: infinite eventloop "
188 "in interrupt\n");
189 break;
190 }
191
192 active = 0;
193
194 for (i = 0; i < MAX_SOCKETS; i++) {
195 unsigned int csc;
196
197
198 csc = indirect_read(&socket[i], I365_CSC);
199 if (csc == 0)
200 continue;
201
202 handled = 1;
203 events = 0;
204
205 if (csc & I365_CSC_DETECT) {
206 events |= SS_DETECT;
207 dev_vdbg(&socket[i].socket.dev,
208 "Card detected in socket %i!\n", i);
209 }
210
211 if (indirect_read(&socket[i], I365_INTCTL)
212 & I365_PC_IOCARD) {
213
214 events |= (csc & I365_CSC_STSCHG)
215 ? SS_STSCHG : 0;
216 } else {
217
218 events |= (csc & I365_CSC_BVD1)
219 ? SS_BATDEAD : 0;
220 events |= (csc & I365_CSC_BVD2)
221 ? SS_BATWARN : 0;
222 events |= (csc & I365_CSC_READY)
223 ? SS_READY : 0;
224 }
225
226 if (events)
227 pcmcia_parse_events(&socket[i].socket, events);
228
229 active |= events;
230 }
231
232 if (active == 0)
233 break;
234 }
235 return IRQ_RETVAL(handled);
236}
237
238
239
240static void pd6729_interrupt_wrapper(unsigned long data)
241{
242 struct pd6729_socket *socket = (struct pd6729_socket *) data;
243
244 pd6729_interrupt(0, (void *)socket);
245 mod_timer(&socket->poll_timer, jiffies + HZ);
246}
247
248static int pd6729_get_status(struct pcmcia_socket *sock, u_int *value)
249{
250 struct pd6729_socket *socket
251 = container_of(sock, struct pd6729_socket, socket);
252 unsigned int status;
253 unsigned int data;
254 struct pd6729_socket *t;
255
256
257 status = indirect_read(socket, I365_STATUS);
258 *value = 0;
259
260 if ((status & I365_CS_DETECT) == I365_CS_DETECT)
261 *value |= SS_DETECT;
262
263
264
265
266
267 if (indirect_read(socket, I365_INTCTL) & I365_PC_IOCARD) {
268
269 if (!(status & I365_CS_STSCHG))
270 *value |= SS_STSCHG;
271 } else {
272
273 if (!(status & I365_CS_BVD1))
274 *value |= SS_BATDEAD;
275 if (!(status & I365_CS_BVD2))
276 *value |= SS_BATWARN;
277 }
278
279 if (status & I365_CS_WRPROT)
280 *value |= SS_WRPROT;
281
282 if (status & I365_CS_READY)
283 *value |= SS_READY;
284
285 if (status & I365_CS_POWERON)
286 *value |= SS_POWERON;
287
288 t = (socket->number) ? socket : socket + 1;
289 indirect_write(t, PD67_EXT_INDEX, PD67_EXTERN_DATA);
290 data = indirect_read16(t, PD67_EXT_DATA);
291 *value |= (data & PD67_EXD_VS1(socket->number)) ? 0 : SS_3VCARD;
292
293 return 0;
294}
295
296
297static int pd6729_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
298{
299 struct pd6729_socket *socket
300 = container_of(sock, struct pd6729_socket, socket);
301 unsigned char reg, data;
302
303
304 indirect_write(socket, I365_GBLCTL, 0x00);
305 indirect_write(socket, I365_GENCTL, 0x00);
306
307
308 socket->card_irq = state->io_irq;
309
310 reg = 0;
311
312 if (!(state->flags & SS_RESET))
313 reg |= I365_PC_RESET;
314 if (state->flags & SS_IOCARD)
315 reg |= I365_PC_IOCARD;
316
317
318 indirect_write(socket, I365_INTCTL, reg);
319
320
321
322 reg = I365_PWR_NORESET;
323
324 if (state->flags & SS_PWR_AUTO) {
325 dev_dbg(&sock->dev, "Auto power\n");
326 reg |= I365_PWR_AUTO;
327 }
328 if (state->flags & SS_OUTPUT_ENA) {
329 dev_dbg(&sock->dev, "Power Enabled\n");
330 reg |= I365_PWR_OUT;
331 }
332
333 switch (state->Vcc) {
334 case 0:
335 break;
336 case 33:
337 dev_dbg(&sock->dev,
338 "setting voltage to Vcc to 3.3V on socket %i\n",
339 socket->number);
340 reg |= I365_VCC_5V;
341 indirect_setbit(socket, PD67_MISC_CTL_1, PD67_MC1_VCC_3V);
342 break;
343 case 50:
344 dev_dbg(&sock->dev,
345 "setting voltage to Vcc to 5V on socket %i\n",
346 socket->number);
347 reg |= I365_VCC_5V;
348 indirect_resetbit(socket, PD67_MISC_CTL_1, PD67_MC1_VCC_3V);
349 break;
350 default:
351 dev_dbg(&sock->dev,
352 "pd6729_set_socket called with invalid VCC power "
353 "value: %i\n", state->Vcc);
354 return -EINVAL;
355 }
356
357 switch (state->Vpp) {
358 case 0:
359 dev_dbg(&sock->dev, "not setting Vpp on socket %i\n",
360 socket->number);
361 break;
362 case 33:
363 case 50:
364 dev_dbg(&sock->dev, "setting Vpp to Vcc for socket %i\n",
365 socket->number);
366 reg |= I365_VPP1_5V;
367 break;
368 case 120:
369 dev_dbg(&sock->dev, "setting Vpp to 12.0\n");
370 reg |= I365_VPP1_12V;
371 break;
372 default:
373 dev_dbg(&sock->dev, "pd6729: pd6729_set_socket called with "
374 "invalid VPP power value: %i\n", state->Vpp);
375 return -EINVAL;
376 }
377
378
379 if (reg != indirect_read(socket, I365_POWER))
380 indirect_write(socket, I365_POWER, reg);
381
382 if (irq_mode == 1) {
383
384 data = PD67_EC1_INV_MGMT_IRQ | PD67_EC1_INV_CARD_IRQ;
385 } else
386 data = 0;
387
388 indirect_write(socket, PD67_EXT_INDEX, PD67_EXT_CTL_1);
389 indirect_write(socket, PD67_EXT_DATA, data);
390
391
392
393 reg = 0x00;
394 if (state->csc_mask & SS_DETECT)
395 reg |= I365_CSC_DETECT;
396
397 if (state->flags & SS_IOCARD) {
398 if (state->csc_mask & SS_STSCHG)
399 reg |= I365_CSC_STSCHG;
400 } else {
401 if (state->csc_mask & SS_BATDEAD)
402 reg |= I365_CSC_BVD1;
403 if (state->csc_mask & SS_BATWARN)
404 reg |= I365_CSC_BVD2;
405 if (state->csc_mask & SS_READY)
406 reg |= I365_CSC_READY;
407 }
408 if (irq_mode == 1)
409 reg |= 0x30;
410 indirect_write(socket, I365_CSCINT, reg);
411
412 reg = indirect_read(socket, I365_INTCTL);
413 if (irq_mode == 1)
414 reg |= 0x03;
415 else
416 reg |= socket->card_irq;
417 indirect_write(socket, I365_INTCTL, reg);
418
419
420 (void)indirect_read(socket, I365_CSC);
421
422 return 0;
423}
424
425static int pd6729_set_io_map(struct pcmcia_socket *sock,
426 struct pccard_io_map *io)
427{
428 struct pd6729_socket *socket
429 = container_of(sock, struct pd6729_socket, socket);
430 unsigned char map, ioctl;
431
432 map = io->map;
433
434
435 if (map > 1) {
436 dev_dbg(&sock->dev, "pd6729_set_io_map with invalid map\n");
437 return -EINVAL;
438 }
439
440
441 if (indirect_read(socket, I365_ADDRWIN) & I365_ENA_IO(map))
442 indirect_resetbit(socket, I365_ADDRWIN, I365_ENA_IO(map));
443
444
445
446
447
448 indirect_write16(socket, I365_IO(map)+I365_W_START, io->start);
449 indirect_write16(socket, I365_IO(map)+I365_W_STOP, io->stop);
450
451 ioctl = indirect_read(socket, I365_IOCTL) & ~I365_IOCTL_MASK(map);
452
453 if (io->flags & MAP_0WS)
454 ioctl |= I365_IOCTL_0WS(map);
455 if (io->flags & MAP_16BIT)
456 ioctl |= I365_IOCTL_16BIT(map);
457 if (io->flags & MAP_AUTOSZ)
458 ioctl |= I365_IOCTL_IOCS16(map);
459
460 indirect_write(socket, I365_IOCTL, ioctl);
461
462
463 if (io->flags & MAP_ACTIVE)
464 indirect_setbit(socket, I365_ADDRWIN, I365_ENA_IO(map));
465
466 return 0;
467}
468
469static int pd6729_set_mem_map(struct pcmcia_socket *sock,
470 struct pccard_mem_map *mem)
471{
472 struct pd6729_socket *socket
473 = container_of(sock, struct pd6729_socket, socket);
474 unsigned short base, i;
475 unsigned char map;
476
477 map = mem->map;
478 if (map > 4) {
479 dev_warn(&sock->dev, "invalid map requested\n");
480 return -EINVAL;
481 }
482
483 if ((mem->res->start > mem->res->end) || (mem->speed > 1000)) {
484 dev_warn(&sock->dev, "invalid invalid address / speed\n");
485 return -EINVAL;
486 }
487
488
489 if (indirect_read(socket, I365_ADDRWIN) & I365_ENA_MEM(map))
490 indirect_resetbit(socket, I365_ADDRWIN, I365_ENA_MEM(map));
491
492
493 base = I365_MEM(map);
494 i = (mem->res->start >> 12) & 0x0fff;
495 if (mem->flags & MAP_16BIT)
496 i |= I365_MEM_16BIT;
497 if (mem->flags & MAP_0WS)
498 i |= I365_MEM_0WS;
499 indirect_write16(socket, base + I365_W_START, i);
500
501
502
503 i = (mem->res->end >> 12) & 0x0fff;
504 switch (to_cycles(mem->speed)) {
505 case 0:
506 break;
507 case 1:
508 i |= I365_MEM_WS0;
509 break;
510 case 2:
511 i |= I365_MEM_WS1;
512 break;
513 default:
514 i |= I365_MEM_WS1 | I365_MEM_WS0;
515 break;
516 }
517
518 indirect_write16(socket, base + I365_W_STOP, i);
519
520
521 indirect_write(socket, PD67_EXT_INDEX, PD67_MEM_PAGE(map));
522 indirect_write(socket, PD67_EXT_DATA, mem->res->start >> 24);
523
524
525
526 i = ((mem->card_start - mem->res->start) >> 12) & 0x3fff;
527 if (mem->flags & MAP_WRPROT)
528 i |= I365_MEM_WRPROT;
529 if (mem->flags & MAP_ATTRIB) {
530
531
532 i |= I365_MEM_REG;
533 } else {
534
535
536 }
537 indirect_write16(socket, base + I365_W_OFF, i);
538
539
540 if (mem->flags & MAP_ACTIVE)
541 indirect_setbit(socket, I365_ADDRWIN, I365_ENA_MEM(map));
542
543 return 0;
544}
545
546static int pd6729_init(struct pcmcia_socket *sock)
547{
548 int i;
549 struct resource res = { .end = 0x0fff };
550 pccard_io_map io = { 0, 0, 0, 0, 1 };
551 pccard_mem_map mem = { .res = &res, };
552
553 pd6729_set_socket(sock, &dead_socket);
554 for (i = 0; i < 2; i++) {
555 io.map = i;
556 pd6729_set_io_map(sock, &io);
557 }
558 for (i = 0; i < 5; i++) {
559 mem.map = i;
560 pd6729_set_mem_map(sock, &mem);
561 }
562
563 return 0;
564}
565
566
567
568static struct pccard_operations pd6729_operations = {
569 .init = pd6729_init,
570 .get_status = pd6729_get_status,
571 .set_socket = pd6729_set_socket,
572 .set_io_map = pd6729_set_io_map,
573 .set_mem_map = pd6729_set_mem_map,
574};
575
576static irqreturn_t pd6729_test(int irq, void *dev)
577{
578 pr_devel("-> hit on irq %d\n", irq);
579 return IRQ_HANDLED;
580}
581
582static int pd6729_check_irq(int irq)
583{
584 int ret;
585
586 ret = request_irq(irq, pd6729_test, IRQF_PROBE_SHARED, "x",
587 pd6729_test);
588 if (ret)
589 return -1;
590
591 free_irq(irq, pd6729_test);
592 return 0;
593}
594
595static u_int __devinit pd6729_isa_scan(void)
596{
597 u_int mask0, mask = 0;
598 int i;
599
600 if (irq_mode == 1) {
601 printk(KERN_INFO "pd6729: PCI card interrupts, "
602 "PCI status changes\n");
603 return 0;
604 }
605
606 mask0 = PD67_MASK;
607
608
609 for (i = 0; i < 16; i++)
610 if ((mask0 & (1 << i)) && (pd6729_check_irq(i) == 0))
611 mask |= (1 << i);
612
613 printk(KERN_INFO "pd6729: ISA irqs = ");
614 for (i = 0; i < 16; i++)
615 if (mask & (1<<i))
616 printk("%s%d", ((mask & ((1<<i)-1)) ? "," : ""), i);
617
618 if (mask == 0)
619 printk("none!");
620 else
621 printk(" polling status changes.\n");
622
623 return mask;
624}
625
626static int __devinit pd6729_pci_probe(struct pci_dev *dev,
627 const struct pci_device_id *id)
628{
629 int i, j, ret;
630 u_int mask;
631 char configbyte;
632 struct pd6729_socket *socket;
633
634 socket = kzalloc(sizeof(struct pd6729_socket) * MAX_SOCKETS,
635 GFP_KERNEL);
636 if (!socket) {
637 dev_warn(&dev->dev, "failed to kzalloc socket.\n");
638 return -ENOMEM;
639 }
640
641 ret = pci_enable_device(dev);
642 if (ret) {
643 dev_warn(&dev->dev, "failed to enable pci_device.\n");
644 goto err_out_free_mem;
645 }
646
647 if (!pci_resource_start(dev, 0)) {
648 dev_warn(&dev->dev, "refusing to load the driver as the "
649 "io_base is NULL.\n");
650 goto err_out_free_mem;
651 }
652
653 dev_info(&dev->dev, "Cirrus PD6729 PCI to PCMCIA Bridge at 0x%llx "
654 "on irq %d\n",
655 (unsigned long long)pci_resource_start(dev, 0), dev->irq);
656
657
658
659
660 pci_read_config_byte(dev, PCI_COMMAND, &configbyte);
661 if (!(configbyte & PCI_COMMAND_MEMORY)) {
662 dev_dbg(&dev->dev, "pd6729: Enabling PCI_COMMAND_MEMORY.\n");
663 configbyte |= PCI_COMMAND_MEMORY;
664 pci_write_config_byte(dev, PCI_COMMAND, configbyte);
665 }
666
667 ret = pci_request_regions(dev, "pd6729");
668 if (ret) {
669 dev_warn(&dev->dev, "pci request region failed.\n");
670 goto err_out_disable;
671 }
672
673 if (dev->irq == NO_IRQ)
674 irq_mode = 0;
675
676 mask = pd6729_isa_scan();
677 if (irq_mode == 0 && mask == 0) {
678 dev_warn(&dev->dev, "no ISA interrupt is available.\n");
679 goto err_out_free_res;
680 }
681
682 for (i = 0; i < MAX_SOCKETS; i++) {
683 socket[i].io_base = pci_resource_start(dev, 0);
684 socket[i].socket.features |= SS_CAP_PAGE_REGS | SS_CAP_PCCARD;
685 socket[i].socket.map_size = 0x1000;
686 socket[i].socket.irq_mask = mask;
687 socket[i].socket.pci_irq = dev->irq;
688 socket[i].socket.cb_dev = dev;
689 socket[i].socket.owner = THIS_MODULE;
690
691 socket[i].number = i;
692
693 socket[i].socket.ops = &pd6729_operations;
694 socket[i].socket.resource_ops = &pccard_nonstatic_ops;
695 socket[i].socket.dev.parent = &dev->dev;
696 socket[i].socket.driver_data = &socket[i];
697 }
698
699 pci_set_drvdata(dev, socket);
700 if (irq_mode == 1) {
701
702 ret = request_irq(dev->irq, pd6729_interrupt, IRQF_SHARED,
703 "pd6729", socket);
704 if (ret) {
705 dev_err(&dev->dev, "Failed to register irq %d\n",
706 dev->irq);
707 goto err_out_free_res;
708 }
709 } else {
710
711 init_timer(&socket->poll_timer);
712 socket->poll_timer.function = pd6729_interrupt_wrapper;
713 socket->poll_timer.data = (unsigned long)socket;
714 socket->poll_timer.expires = jiffies + HZ;
715 add_timer(&socket->poll_timer);
716 }
717
718 for (i = 0; i < MAX_SOCKETS; i++) {
719 ret = pcmcia_register_socket(&socket[i].socket);
720 if (ret) {
721 dev_warn(&dev->dev, "pcmcia_register_socket failed.\n");
722 for (j = 0; j < i ; j++)
723 pcmcia_unregister_socket(&socket[j].socket);
724 goto err_out_free_res2;
725 }
726 }
727
728 return 0;
729
730 err_out_free_res2:
731 if (irq_mode == 1)
732 free_irq(dev->irq, socket);
733 else
734 del_timer_sync(&socket->poll_timer);
735 err_out_free_res:
736 pci_release_regions(dev);
737 err_out_disable:
738 pci_disable_device(dev);
739
740 err_out_free_mem:
741 kfree(socket);
742 return ret;
743}
744
745static void __devexit pd6729_pci_remove(struct pci_dev *dev)
746{
747 int i;
748 struct pd6729_socket *socket = pci_get_drvdata(dev);
749
750 for (i = 0; i < MAX_SOCKETS; i++) {
751
752 indirect_write(&socket[i], I365_CSCINT, 0);
753 indirect_write(&socket[i], I365_INTCTL, 0);
754
755 pcmcia_unregister_socket(&socket[i].socket);
756 }
757
758 if (irq_mode == 1)
759 free_irq(dev->irq, socket);
760 else
761 del_timer_sync(&socket->poll_timer);
762 pci_release_regions(dev);
763 pci_disable_device(dev);
764
765 kfree(socket);
766}
767
768static struct pci_device_id pd6729_pci_ids[] = {
769 {
770 .vendor = PCI_VENDOR_ID_CIRRUS,
771 .device = PCI_DEVICE_ID_CIRRUS_6729,
772 .subvendor = PCI_ANY_ID,
773 .subdevice = PCI_ANY_ID,
774 },
775 { }
776};
777MODULE_DEVICE_TABLE(pci, pd6729_pci_ids);
778
779static struct pci_driver pd6729_pci_driver = {
780 .name = "pd6729",
781 .id_table = pd6729_pci_ids,
782 .probe = pd6729_pci_probe,
783 .remove = __devexit_p(pd6729_pci_remove),
784};
785
786static int pd6729_module_init(void)
787{
788 return pci_register_driver(&pd6729_pci_driver);
789}
790
791static void pd6729_module_exit(void)
792{
793 pci_unregister_driver(&pd6729_pci_driver);
794}
795
796module_init(pd6729_module_init);
797module_exit(pd6729_module_exit);
798