Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * drivers/pcmcia/sa1100_simpad.c | |
3 | * | |
4 | * PCMCIA implementation routines for simpad | |
5 | * | |
6 | */ | |
7 | #include <linux/module.h> | |
8 | #include <linux/kernel.h> | |
1da177e4 LT |
9 | #include <linux/device.h> |
10 | #include <linux/init.h> | |
11 | ||
a09e64fb | 12 | #include <mach/hardware.h> |
1da177e4 LT |
13 | #include <asm/mach-types.h> |
14 | #include <asm/irq.h> | |
a09e64fb | 15 | #include <mach/simpad.h> |
1da177e4 LT |
16 | #include "sa1100_generic.h" |
17 | ||
1da177e4 LT |
18 | static int simpad_pcmcia_hw_init(struct soc_pcmcia_socket *skt) |
19 | { | |
20 | ||
de0bc0d1 | 21 | simpad_clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1); |
1da177e4 | 22 | |
b1d8a5f9 RK |
23 | skt->stat[SOC_STAT_CD].gpio = GPIO_CF_CD; |
24 | skt->stat[SOC_STAT_CD].name = "CF_CD"; | |
25 | skt->stat[SOC_STAT_RDY].gpio = GPIO_CF_IRQ; | |
26 | skt->stat[SOC_STAT_RDY].name = "CF_RDY"; | |
1da177e4 | 27 | |
b1d8a5f9 | 28 | return 0; |
1da177e4 LT |
29 | } |
30 | ||
31 | static void simpad_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt) | |
32 | { | |
1da177e4 | 33 | /* Disable CF bus: */ |
de0bc0d1 JF |
34 | /*simpad_set_cs3_bit(PCMCIA_BUFF_DIS);*/ |
35 | simpad_clear_cs3_bit(PCMCIA_RESET); | |
1da177e4 LT |
36 | } |
37 | ||
38 | static void | |
39 | simpad_pcmcia_socket_state(struct soc_pcmcia_socket *skt, | |
40 | struct pcmcia_state *state) | |
41 | { | |
de0bc0d1 | 42 | long cs3reg = simpad_get_cs3_ro(); |
1da177e4 | 43 | |
b1d8a5f9 RK |
44 | /* the detect signal is inverted - fix that up here */ |
45 | state->detect = !state->detect; | |
46 | ||
de0bc0d1 JF |
47 | state->bvd1 = 1; /* Might be cs3reg & PCMCIA_BVD1 */ |
48 | state->bvd2 = 1; /* Might be cs3reg & PCMCIA_BVD2 */ | |
de0bc0d1 JF |
49 | |
50 | if ((cs3reg & (PCMCIA_VS1|PCMCIA_VS2)) == | |
51 | (PCMCIA_VS1|PCMCIA_VS2)) { | |
1da177e4 LT |
52 | state->vs_3v=0; |
53 | state->vs_Xv=0; | |
54 | } else { | |
55 | state->vs_3v=1; | |
56 | state->vs_Xv=0; | |
57 | } | |
58 | } | |
59 | ||
60 | static int | |
61 | simpad_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, | |
62 | const socket_state_t *state) | |
63 | { | |
64 | unsigned long flags; | |
65 | ||
66 | local_irq_save(flags); | |
67 | ||
68 | /* Murphy: see table of MIC2562a-1 */ | |
69 | switch (state->Vcc) { | |
70 | case 0: | |
de0bc0d1 | 71 | simpad_clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1); |
1da177e4 LT |
72 | break; |
73 | ||
74 | case 33: | |
de0bc0d1 JF |
75 | simpad_clear_cs3_bit(VCC_3V_EN|EN1); |
76 | simpad_set_cs3_bit(VCC_5V_EN|EN0); | |
1da177e4 LT |
77 | break; |
78 | ||
79 | case 50: | |
de0bc0d1 JF |
80 | simpad_clear_cs3_bit(VCC_5V_EN|EN1); |
81 | simpad_set_cs3_bit(VCC_3V_EN|EN0); | |
1da177e4 LT |
82 | break; |
83 | ||
84 | default: | |
85 | printk(KERN_ERR "%s(): unrecognized Vcc %u\n", | |
2e11cb4c | 86 | __func__, state->Vcc); |
de0bc0d1 | 87 | simpad_clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1); |
1da177e4 LT |
88 | local_irq_restore(flags); |
89 | return -1; | |
90 | } | |
91 | ||
92 | ||
93 | local_irq_restore(flags); | |
94 | ||
95 | return 0; | |
96 | } | |
97 | ||
1da177e4 LT |
98 | static void simpad_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt) |
99 | { | |
de0bc0d1 | 100 | simpad_set_cs3_bit(PCMCIA_RESET); |
1da177e4 LT |
101 | } |
102 | ||
103 | static struct pcmcia_low_level simpad_pcmcia_ops = { | |
104 | .owner = THIS_MODULE, | |
105 | .hw_init = simpad_pcmcia_hw_init, | |
106 | .hw_shutdown = simpad_pcmcia_hw_shutdown, | |
107 | .socket_state = simpad_pcmcia_socket_state, | |
108 | .configure_socket = simpad_pcmcia_configure_socket, | |
1da177e4 LT |
109 | .socket_suspend = simpad_pcmcia_socket_suspend, |
110 | }; | |
111 | ||
34cdf25a | 112 | int pcmcia_simpad_init(struct device *dev) |
1da177e4 LT |
113 | { |
114 | int ret = -ENODEV; | |
115 | ||
116 | if (machine_is_simpad()) | |
117 | ret = sa11xx_drv_pcmcia_probe(dev, &simpad_pcmcia_ops, 1, 1); | |
118 | ||
119 | return ret; | |
120 | } |