2 * linux/drivers/pcmcia/sa1111_generic.c
4 * We implement the generic parts of a SA1111 PCMCIA driver. This
5 * basically means we handle everything except controlling the
6 * power. Power is machine specific...
8 #include <linux/module.h>
9 #include <linux/kernel.h>
10 #include <linux/ioport.h>
11 #include <linux/device.h>
12 #include <linux/interrupt.h>
13 #include <linux/init.h>
16 #include <pcmcia/ss.h>
18 #include <mach/hardware.h>
19 #include <asm/hardware/sa1111.h>
22 #include "sa1111_generic.h"
24 static struct pcmcia_irqs irqs
[] = {
25 { 0, IRQ_S0_CD_VALID
, "SA1111 PCMCIA card detect" },
26 { 0, IRQ_S0_BVD1_STSCHG
, "SA1111 PCMCIA BVD1" },
27 { 1, IRQ_S1_CD_VALID
, "SA1111 CF card detect" },
28 { 1, IRQ_S1_BVD1_STSCHG
, "SA1111 CF BVD1" },
31 static int sa1111_pcmcia_hw_init(struct soc_pcmcia_socket
*skt
)
33 return soc_pcmcia_request_irqs(skt
, irqs
, ARRAY_SIZE(irqs
));
36 static void sa1111_pcmcia_hw_shutdown(struct soc_pcmcia_socket
*skt
)
38 soc_pcmcia_free_irqs(skt
, irqs
, ARRAY_SIZE(irqs
));
41 void sa1111_pcmcia_socket_state(struct soc_pcmcia_socket
*skt
, struct pcmcia_state
*state
)
43 struct sa1111_pcmcia_socket
*s
= to_skt(skt
);
44 unsigned long status
= sa1111_readl(s
->dev
->mapbase
+ SA1111_PCSR
);
48 state
->detect
= status
& PCSR_S0_DETECT
? 0 : 1;
49 state
->ready
= status
& PCSR_S0_READY
? 1 : 0;
50 state
->bvd1
= status
& PCSR_S0_BVD1
? 1 : 0;
51 state
->bvd2
= status
& PCSR_S0_BVD2
? 1 : 0;
52 state
->wrprot
= status
& PCSR_S0_WP
? 1 : 0;
53 state
->vs_3v
= status
& PCSR_S0_VS1
? 0 : 1;
54 state
->vs_Xv
= status
& PCSR_S0_VS2
? 0 : 1;
58 state
->detect
= status
& PCSR_S1_DETECT
? 0 : 1;
59 state
->ready
= status
& PCSR_S1_READY
? 1 : 0;
60 state
->bvd1
= status
& PCSR_S1_BVD1
? 1 : 0;
61 state
->bvd2
= status
& PCSR_S1_BVD2
? 1 : 0;
62 state
->wrprot
= status
& PCSR_S1_WP
? 1 : 0;
63 state
->vs_3v
= status
& PCSR_S1_VS1
? 0 : 1;
64 state
->vs_Xv
= status
& PCSR_S1_VS2
? 0 : 1;
69 int sa1111_pcmcia_configure_socket(struct soc_pcmcia_socket
*skt
, const socket_state_t
*state
)
71 struct sa1111_pcmcia_socket
*s
= to_skt(skt
);
72 unsigned int pccr_skt_mask
, pccr_set_mask
, val
;
77 pccr_skt_mask
= PCCR_S0_RST
|PCCR_S0_FLT
|PCCR_S0_PWAITEN
|PCCR_S0_PSE
;
81 pccr_skt_mask
= PCCR_S1_RST
|PCCR_S1_FLT
|PCCR_S1_PWAITEN
|PCCR_S1_PSE
;
91 pccr_set_mask
|= PCCR_S0_PWAITEN
|PCCR_S1_PWAITEN
;
93 pccr_set_mask
|= PCCR_S0_PSE
|PCCR_S1_PSE
;
94 if (state
->flags
& SS_RESET
)
95 pccr_set_mask
|= PCCR_S0_RST
|PCCR_S1_RST
;
96 if (state
->flags
& SS_OUTPUT_ENA
)
97 pccr_set_mask
|= PCCR_S0_FLT
|PCCR_S1_FLT
;
99 local_irq_save(flags
);
100 val
= sa1111_readl(s
->dev
->mapbase
+ SA1111_PCCR
);
101 val
&= ~pccr_skt_mask
;
102 val
|= pccr_set_mask
& pccr_skt_mask
;
103 sa1111_writel(val
, s
->dev
->mapbase
+ SA1111_PCCR
);
104 local_irq_restore(flags
);
109 void sa1111_pcmcia_socket_init(struct soc_pcmcia_socket
*skt
)
111 soc_pcmcia_enable_irqs(skt
, irqs
, ARRAY_SIZE(irqs
));
114 static void sa1111_pcmcia_socket_suspend(struct soc_pcmcia_socket
*skt
)
116 soc_pcmcia_disable_irqs(skt
, irqs
, ARRAY_SIZE(irqs
));
119 int sa1111_pcmcia_add(struct sa1111_dev
*dev
, struct pcmcia_low_level
*ops
,
120 int (*add
)(struct soc_pcmcia_socket
*))
122 struct sa1111_pcmcia_socket
*s
;
125 ops
->hw_init
= sa1111_pcmcia_hw_init
;
126 ops
->hw_shutdown
= sa1111_pcmcia_hw_shutdown
;
127 ops
->socket_state
= sa1111_pcmcia_socket_state
;
128 ops
->socket_suspend
= sa1111_pcmcia_socket_suspend
;
130 s
= kzalloc(sizeof(*s
) * ops
->nr
, GFP_KERNEL
);
134 for (i
= 0; i
< ops
->nr
; i
++) {
135 s
= kzalloc(sizeof(*s
), GFP_KERNEL
);
139 s
->soc
.nr
= ops
->first
+ i
;
141 s
->soc
.socket
.owner
= ops
->owner
;
142 s
->soc
.socket
.dev
.parent
= &dev
->dev
;
143 s
->soc
.socket
.pci_irq
= s
->soc
.nr
? IRQ_S1_READY_NINT
: IRQ_S0_READY_NINT
;
148 s
->next
= dev_get_drvdata(&dev
->dev
);
149 dev_set_drvdata(&dev
->dev
, s
);
157 static int pcmcia_probe(struct sa1111_dev
*dev
)
161 dev_set_drvdata(&dev
->dev
, NULL
);
163 if (!request_mem_region(dev
->res
.start
, 512,
164 SA1111_DRIVER_NAME(dev
)))
170 * Initialise the suspend state.
172 sa1111_writel(PCSSR_S0_SLEEP
| PCSSR_S1_SLEEP
, base
+ SA1111_PCSSR
);
173 sa1111_writel(PCCR_S0_FLT
| PCCR_S1_FLT
, base
+ SA1111_PCCR
);
175 #ifdef CONFIG_SA1100_BADGE4
176 pcmcia_badge4_init(&dev
->dev
);
178 #ifdef CONFIG_SA1100_JORNADA720
179 pcmcia_jornada720_init(&dev
->dev
);
181 #ifdef CONFIG_ARCH_LUBBOCK
182 pcmcia_lubbock_init(dev
);
184 #ifdef CONFIG_ASSABET_NEPONSET
185 pcmcia_neponset_init(dev
);
190 static int __devexit
pcmcia_remove(struct sa1111_dev
*dev
)
192 struct sa1111_pcmcia_socket
*next
, *s
= dev_get_drvdata(&dev
->dev
);
194 dev_set_drvdata(&dev
->dev
, NULL
);
196 for (; next
= s
->next
, s
; s
= next
) {
197 soc_pcmcia_remove_one(&s
->soc
);
201 release_mem_region(dev
->res
.start
, 512);
205 static int pcmcia_suspend(struct sa1111_dev
*dev
, pm_message_t state
)
207 return pcmcia_socket_dev_suspend(&dev
->dev
);
210 static int pcmcia_resume(struct sa1111_dev
*dev
)
212 return pcmcia_socket_dev_resume(&dev
->dev
);
215 static struct sa1111_driver pcmcia_driver
= {
217 .name
= "sa1111-pcmcia",
219 .devid
= SA1111_DEVID_PCMCIA
,
220 .probe
= pcmcia_probe
,
221 .remove
= __devexit_p(pcmcia_remove
),
222 .suspend
= pcmcia_suspend
,
223 .resume
= pcmcia_resume
,
226 static int __init
sa1111_drv_pcmcia_init(void)
228 return sa1111_driver_register(&pcmcia_driver
);
231 static void __exit
sa1111_drv_pcmcia_exit(void)
233 sa1111_driver_unregister(&pcmcia_driver
);
236 fs_initcall(sa1111_drv_pcmcia_init
);
237 module_exit(sa1111_drv_pcmcia_exit
);
239 MODULE_DESCRIPTION("SA1111 PCMCIA card socket driver");
240 MODULE_LICENSE("GPL");