diff options
author | Maxime Bizon <mbizon@freebox.fr> | 2009-09-28 08:49:43 -0400 |
---|---|---|
committer | Ralf Baechle <ralf@linux-mips.org> | 2009-09-30 15:47:01 -0400 |
commit | 553d6d5f5b84f11fad8043688137dac96df1a06d (patch) | |
tree | 39613a02feb6617d619c84045d3c41e479a566b5 | |
parent | 971842677c5a6c1dd15d9a80b67bf0085686e574 (diff) |
MIPS: BCM63xx: Add PCMCIA & Cardbus support.
Signed-off-by: Maxime Bizon <mbizon@freebox.fr>
Reviewed-by: Wolfram Sang <w.sang@pengutronix.de>
Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
-rw-r--r-- | arch/mips/bcm63xx/Makefile | 2 | ||||
-rw-r--r-- | arch/mips/bcm63xx/boards/board_bcm963xx.c | 4 | ||||
-rw-r--r-- | arch/mips/bcm63xx/dev-pcmcia.c | 144 | ||||
-rw-r--r-- | arch/mips/include/asm/mach-bcm63xx/bcm63xx_dev_pcmcia.h | 13 | ||||
-rw-r--r-- | drivers/pcmcia/Kconfig | 4 | ||||
-rw-r--r-- | drivers/pcmcia/Makefile | 1 | ||||
-rw-r--r-- | drivers/pcmcia/bcm63xx_pcmcia.c | 536 | ||||
-rw-r--r-- | drivers/pcmcia/bcm63xx_pcmcia.h | 60 |
8 files changed, 763 insertions, 1 deletions
diff --git a/arch/mips/bcm63xx/Makefile b/arch/mips/bcm63xx/Makefile index cff75de8449b..c146d1ededed 100644 --- a/arch/mips/bcm63xx/Makefile +++ b/arch/mips/bcm63xx/Makefile | |||
@@ -1,5 +1,5 @@ | |||
1 | obj-y += clk.o cpu.o cs.o gpio.o irq.o prom.o setup.o timer.o \ | 1 | obj-y += clk.o cpu.o cs.o gpio.o irq.o prom.o setup.o timer.o \ |
2 | dev-dsp.o dev-enet.o dev-uart.o | 2 | dev-dsp.o dev-enet.o dev-pcmcia.o dev-uart.o |
3 | obj-$(CONFIG_EARLY_PRINTK) += early_printk.o | 3 | obj-$(CONFIG_EARLY_PRINTK) += early_printk.o |
4 | 4 | ||
5 | obj-y += boards/ | 5 | obj-y += boards/ |
diff --git a/arch/mips/bcm63xx/boards/board_bcm963xx.c b/arch/mips/bcm63xx/boards/board_bcm963xx.c index 5a327f3a7167..78e155d21be6 100644 --- a/arch/mips/bcm63xx/boards/board_bcm963xx.c +++ b/arch/mips/bcm63xx/boards/board_bcm963xx.c | |||
@@ -23,6 +23,7 @@ | |||
23 | #include <bcm63xx_dev_pci.h> | 23 | #include <bcm63xx_dev_pci.h> |
24 | #include <bcm63xx_dev_enet.h> | 24 | #include <bcm63xx_dev_enet.h> |
25 | #include <bcm63xx_dev_dsp.h> | 25 | #include <bcm63xx_dev_dsp.h> |
26 | #include <bcm63xx_dev_pcmcia.h> | ||
26 | #include <bcm63xx_dev_uart.h> | 27 | #include <bcm63xx_dev_uart.h> |
27 | #include <board_bcm963xx.h> | 28 | #include <board_bcm963xx.h> |
28 | 29 | ||
@@ -795,6 +796,9 @@ int __init board_register_devices(void) | |||
795 | 796 | ||
796 | bcm63xx_uart_register(); | 797 | bcm63xx_uart_register(); |
797 | 798 | ||
799 | if (board.has_pccard) | ||
800 | bcm63xx_pcmcia_register(); | ||
801 | |||
798 | if (board.has_enet0 && | 802 | if (board.has_enet0 && |
799 | !board_get_mac_address(board.enet0.mac_addr)) | 803 | !board_get_mac_address(board.enet0.mac_addr)) |
800 | bcm63xx_enet_register(0, &board.enet0); | 804 | bcm63xx_enet_register(0, &board.enet0); |
diff --git a/arch/mips/bcm63xx/dev-pcmcia.c b/arch/mips/bcm63xx/dev-pcmcia.c new file mode 100644 index 000000000000..de4d917fd54d --- /dev/null +++ b/arch/mips/bcm63xx/dev-pcmcia.c | |||
@@ -0,0 +1,144 @@ | |||
1 | /* | ||
2 | * This file is subject to the terms and conditions of the GNU General Public | ||
3 | * License. See the file "COPYING" in the main directory of this archive | ||
4 | * for more details. | ||
5 | * | ||
6 | * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> | ||
7 | */ | ||
8 | |||
9 | #include <linux/init.h> | ||
10 | #include <linux/kernel.h> | ||
11 | #include <asm/bootinfo.h> | ||
12 | #include <linux/platform_device.h> | ||
13 | #include <bcm63xx_cs.h> | ||
14 | #include <bcm63xx_cpu.h> | ||
15 | #include <bcm63xx_dev_pcmcia.h> | ||
16 | #include <bcm63xx_io.h> | ||
17 | #include <bcm63xx_regs.h> | ||
18 | |||
19 | static struct resource pcmcia_resources[] = { | ||
20 | /* pcmcia registers */ | ||
21 | { | ||
22 | /* start & end filled at runtime */ | ||
23 | .flags = IORESOURCE_MEM, | ||
24 | }, | ||
25 | |||
26 | /* pcmcia memory zone resources */ | ||
27 | { | ||
28 | .start = BCM_PCMCIA_COMMON_BASE_PA, | ||
29 | .end = BCM_PCMCIA_COMMON_END_PA, | ||
30 | .flags = IORESOURCE_MEM, | ||
31 | }, | ||
32 | { | ||
33 | .start = BCM_PCMCIA_ATTR_BASE_PA, | ||
34 | .end = BCM_PCMCIA_ATTR_END_PA, | ||
35 | .flags = IORESOURCE_MEM, | ||
36 | }, | ||
37 | { | ||
38 | .start = BCM_PCMCIA_IO_BASE_PA, | ||
39 | .end = BCM_PCMCIA_IO_END_PA, | ||
40 | .flags = IORESOURCE_MEM, | ||
41 | }, | ||
42 | |||
43 | /* PCMCIA irq */ | ||
44 | { | ||
45 | /* start filled at runtime */ | ||
46 | .flags = IORESOURCE_IRQ, | ||
47 | }, | ||
48 | |||
49 | /* declare PCMCIA IO resource also */ | ||
50 | { | ||
51 | .start = BCM_PCMCIA_IO_BASE_PA, | ||
52 | .end = BCM_PCMCIA_IO_END_PA, | ||
53 | .flags = IORESOURCE_IO, | ||
54 | }, | ||
55 | }; | ||
56 | |||
57 | static struct bcm63xx_pcmcia_platform_data pd; | ||
58 | |||
59 | static struct platform_device bcm63xx_pcmcia_device = { | ||
60 | .name = "bcm63xx_pcmcia", | ||
61 | .id = 0, | ||
62 | .num_resources = ARRAY_SIZE(pcmcia_resources), | ||
63 | .resource = pcmcia_resources, | ||
64 | .dev = { | ||
65 | .platform_data = &pd, | ||
66 | }, | ||
67 | }; | ||
68 | |||
69 | static int __init config_pcmcia_cs(unsigned int cs, | ||
70 | u32 base, unsigned int size) | ||
71 | { | ||
72 | int ret; | ||
73 | |||
74 | ret = bcm63xx_set_cs_status(cs, 0); | ||
75 | if (!ret) | ||
76 | ret = bcm63xx_set_cs_base(cs, base, size); | ||
77 | if (!ret) | ||
78 | ret = bcm63xx_set_cs_status(cs, 1); | ||
79 | return ret; | ||
80 | } | ||
81 | |||
82 | static const __initdata struct { | ||
83 | unsigned int cs; | ||
84 | unsigned int base; | ||
85 | unsigned int size; | ||
86 | } pcmcia_cs[3] = { | ||
87 | { | ||
88 | .cs = MPI_CS_PCMCIA_COMMON, | ||
89 | .base = BCM_PCMCIA_COMMON_BASE_PA, | ||
90 | .size = BCM_PCMCIA_COMMON_SIZE | ||
91 | }, | ||
92 | { | ||
93 | .cs = MPI_CS_PCMCIA_ATTR, | ||
94 | .base = BCM_PCMCIA_ATTR_BASE_PA, | ||
95 | .size = BCM_PCMCIA_ATTR_SIZE | ||
96 | }, | ||
97 | { | ||
98 | .cs = MPI_CS_PCMCIA_IO, | ||
99 | .base = BCM_PCMCIA_IO_BASE_PA, | ||
100 | .size = BCM_PCMCIA_IO_SIZE | ||
101 | }, | ||
102 | }; | ||
103 | |||
104 | int __init bcm63xx_pcmcia_register(void) | ||
105 | { | ||
106 | int ret, i; | ||
107 | |||
108 | if (!BCMCPU_IS_6348() && !BCMCPU_IS_6358()) | ||
109 | return 0; | ||
110 | |||
111 | /* use correct pcmcia ready gpio depending on processor */ | ||
112 | switch (bcm63xx_get_cpu_id()) { | ||
113 | case BCM6348_CPU_ID: | ||
114 | pd.ready_gpio = 22; | ||
115 | break; | ||
116 | |||
117 | case BCM6358_CPU_ID: | ||
118 | pd.ready_gpio = 18; | ||
119 | break; | ||
120 | |||
121 | default: | ||
122 | return -ENODEV; | ||
123 | } | ||
124 | |||
125 | pcmcia_resources[0].start = bcm63xx_regset_address(RSET_PCMCIA); | ||
126 | pcmcia_resources[0].end = pcmcia_resources[0].start + | ||
127 | RSET_PCMCIA_SIZE - 1; | ||
128 | pcmcia_resources[4].start = bcm63xx_get_irq_number(IRQ_PCMCIA); | ||
129 | |||
130 | /* configure pcmcia chip selects */ | ||
131 | for (i = 0; i < 3; i++) { | ||
132 | ret = config_pcmcia_cs(pcmcia_cs[i].cs, | ||
133 | pcmcia_cs[i].base, | ||
134 | pcmcia_cs[i].size); | ||
135 | if (ret) | ||
136 | goto out_err; | ||
137 | } | ||
138 | |||
139 | return platform_device_register(&bcm63xx_pcmcia_device); | ||
140 | |||
141 | out_err: | ||
142 | printk(KERN_ERR "unable to set pcmcia chip select\n"); | ||
143 | return ret; | ||
144 | } | ||
diff --git a/arch/mips/include/asm/mach-bcm63xx/bcm63xx_dev_pcmcia.h b/arch/mips/include/asm/mach-bcm63xx/bcm63xx_dev_pcmcia.h new file mode 100644 index 000000000000..2beb3969ce3b --- /dev/null +++ b/arch/mips/include/asm/mach-bcm63xx/bcm63xx_dev_pcmcia.h | |||
@@ -0,0 +1,13 @@ | |||
1 | #ifndef BCM63XX_DEV_PCMCIA_H_ | ||
2 | #define BCM63XX_DEV_PCMCIA_H_ | ||
3 | |||
4 | /* | ||
5 | * PCMCIA driver platform data | ||
6 | */ | ||
7 | struct bcm63xx_pcmcia_platform_data { | ||
8 | unsigned int ready_gpio; | ||
9 | }; | ||
10 | |||
11 | int bcm63xx_pcmcia_register(void); | ||
12 | |||
13 | #endif /* BCM63XX_DEV_PCMCIA_H_ */ | ||
diff --git a/drivers/pcmcia/Kconfig b/drivers/pcmcia/Kconfig index fbf965b31c14..17f38a781d47 100644 --- a/drivers/pcmcia/Kconfig +++ b/drivers/pcmcia/Kconfig | |||
@@ -192,6 +192,10 @@ config PCMCIA_AU1X00 | |||
192 | tristate "Au1x00 pcmcia support" | 192 | tristate "Au1x00 pcmcia support" |
193 | depends on SOC_AU1X00 && PCMCIA | 193 | depends on SOC_AU1X00 && PCMCIA |
194 | 194 | ||
195 | config PCMCIA_BCM63XX | ||
196 | tristate "bcm63xx pcmcia support" | ||
197 | depends on BCM63XX && PCMCIA | ||
198 | |||
195 | config PCMCIA_SA1100 | 199 | config PCMCIA_SA1100 |
196 | tristate "SA1100 support" | 200 | tristate "SA1100 support" |
197 | depends on ARM && ARCH_SA1100 && PCMCIA | 201 | depends on ARM && ARCH_SA1100 && PCMCIA |
diff --git a/drivers/pcmcia/Makefile b/drivers/pcmcia/Makefile index 3247828aa203..a03a38acd77d 100644 --- a/drivers/pcmcia/Makefile +++ b/drivers/pcmcia/Makefile | |||
@@ -27,6 +27,7 @@ obj-$(CONFIG_PCMCIA_SA1111) += sa11xx_core.o sa1111_cs.o | |||
27 | obj-$(CONFIG_M32R_PCC) += m32r_pcc.o | 27 | obj-$(CONFIG_M32R_PCC) += m32r_pcc.o |
28 | obj-$(CONFIG_M32R_CFC) += m32r_cfc.o | 28 | obj-$(CONFIG_M32R_CFC) += m32r_cfc.o |
29 | obj-$(CONFIG_PCMCIA_AU1X00) += au1x00_ss.o | 29 | obj-$(CONFIG_PCMCIA_AU1X00) += au1x00_ss.o |
30 | obj-$(CONFIG_PCMCIA_BCM63XX) += bcm63xx_pcmcia.o | ||
30 | obj-$(CONFIG_PCMCIA_VRC4171) += vrc4171_card.o | 31 | obj-$(CONFIG_PCMCIA_VRC4171) += vrc4171_card.o |
31 | obj-$(CONFIG_PCMCIA_VRC4173) += vrc4173_cardu.o | 32 | obj-$(CONFIG_PCMCIA_VRC4173) += vrc4173_cardu.o |
32 | obj-$(CONFIG_OMAP_CF) += omap_cf.o | 33 | obj-$(CONFIG_OMAP_CF) += omap_cf.o |
diff --git a/drivers/pcmcia/bcm63xx_pcmcia.c b/drivers/pcmcia/bcm63xx_pcmcia.c new file mode 100644 index 000000000000..bc88a3b19bb3 --- /dev/null +++ b/drivers/pcmcia/bcm63xx_pcmcia.c | |||
@@ -0,0 +1,536 @@ | |||
1 | /* | ||
2 | * This file is subject to the terms and conditions of the GNU General Public | ||
3 | * License. See the file "COPYING" in the main directory of this archive | ||
4 | * for more details. | ||
5 | * | ||
6 | * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> | ||
7 | */ | ||
8 | |||
9 | #include <linux/kernel.h> | ||
10 | #include <linux/module.h> | ||
11 | #include <linux/ioport.h> | ||
12 | #include <linux/timer.h> | ||
13 | #include <linux/platform_device.h> | ||
14 | #include <linux/delay.h> | ||
15 | #include <linux/pci.h> | ||
16 | #include <linux/gpio.h> | ||
17 | |||
18 | #include <bcm63xx_regs.h> | ||
19 | #include <bcm63xx_io.h> | ||
20 | #include "bcm63xx_pcmcia.h" | ||
21 | |||
22 | #define PFX "bcm63xx_pcmcia: " | ||
23 | |||
24 | #ifdef CONFIG_CARDBUS | ||
25 | /* if cardbus is used, platform device needs reference to actual pci | ||
26 | * device */ | ||
27 | static struct pci_dev *bcm63xx_cb_dev; | ||
28 | #endif | ||
29 | |||
30 | /* | ||
31 | * read/write helper for pcmcia regs | ||
32 | */ | ||
33 | static inline u32 pcmcia_readl(struct bcm63xx_pcmcia_socket *skt, u32 off) | ||
34 | { | ||
35 | return bcm_readl(skt->base + off); | ||
36 | } | ||
37 | |||
38 | static inline void pcmcia_writel(struct bcm63xx_pcmcia_socket *skt, | ||
39 | u32 val, u32 off) | ||
40 | { | ||
41 | bcm_writel(val, skt->base + off); | ||
42 | } | ||
43 | |||
44 | /* | ||
45 | * This callback should (re-)initialise the socket, turn on status | ||
46 | * interrupts and PCMCIA bus, and wait for power to stabilise so that | ||
47 | * the card status signals report correctly. | ||
48 | * | ||
49 | * Hardware cannot do that. | ||
50 | */ | ||
51 | static int bcm63xx_pcmcia_sock_init(struct pcmcia_socket *sock) | ||
52 | { | ||
53 | return 0; | ||
54 | } | ||
55 | |||
56 | /* | ||
57 | * This callback should remove power on the socket, disable IRQs from | ||
58 | * the card, turn off status interrupts, and disable the PCMCIA bus. | ||
59 | * | ||
60 | * Hardware cannot do that. | ||
61 | */ | ||
62 | static int bcm63xx_pcmcia_suspend(struct pcmcia_socket *sock) | ||
63 | { | ||
64 | return 0; | ||
65 | } | ||
66 | |||
67 | /* | ||
68 | * Implements the set_socket() operation for the in-kernel PCMCIA | ||
69 | * service (formerly SS_SetSocket in Card Services). We more or | ||
70 | * less punt all of this work and let the kernel handle the details | ||
71 | * of power configuration, reset, &c. We also record the value of | ||
72 | * `state' in order to regurgitate it to the PCMCIA core later. | ||
73 | */ | ||
74 | static int bcm63xx_pcmcia_set_socket(struct pcmcia_socket *sock, | ||
75 | socket_state_t *state) | ||
76 | { | ||
77 | struct bcm63xx_pcmcia_socket *skt; | ||
78 | unsigned long flags; | ||
79 | u32 val; | ||
80 | |||
81 | skt = sock->driver_data; | ||
82 | |||
83 | spin_lock_irqsave(&skt->lock, flags); | ||
84 | |||
85 | /* note: hardware cannot control socket power, so we will | ||
86 | * always report SS_POWERON */ | ||
87 | |||
88 | /* apply socket reset */ | ||
89 | val = pcmcia_readl(skt, PCMCIA_C1_REG); | ||
90 | if (state->flags & SS_RESET) | ||
91 | val |= PCMCIA_C1_RESET_MASK; | ||
92 | else | ||
93 | val &= ~PCMCIA_C1_RESET_MASK; | ||
94 | |||
95 | /* reverse reset logic for cardbus card */ | ||
96 | if (skt->card_detected && (skt->card_type & CARD_CARDBUS)) | ||
97 | val ^= PCMCIA_C1_RESET_MASK; | ||
98 | |||
99 | pcmcia_writel(skt, val, PCMCIA_C1_REG); | ||
100 | |||
101 | /* keep requested state for event reporting */ | ||
102 | skt->requested_state = *state; | ||
103 | |||
104 | spin_unlock_irqrestore(&skt->lock, flags); | ||
105 | |||
106 | return 0; | ||
107 | } | ||
108 | |||
109 | /* | ||
110 | * identity cardtype from VS[12] input, CD[12] input while only VS2 is | ||
111 | * floating, and CD[12] input while only VS1 is floating | ||
112 | */ | ||
113 | enum { | ||
114 | IN_VS1 = (1 << 0), | ||
115 | IN_VS2 = (1 << 1), | ||
116 | IN_CD1_VS2H = (1 << 2), | ||
117 | IN_CD2_VS2H = (1 << 3), | ||
118 | IN_CD1_VS1H = (1 << 4), | ||
119 | IN_CD2_VS1H = (1 << 5), | ||
120 | }; | ||
121 | |||
122 | static const u8 vscd_to_cardtype[] = { | ||
123 | |||
124 | /* VS1 float, VS2 float */ | ||
125 | [IN_VS1 | IN_VS2] = (CARD_PCCARD | CARD_5V), | ||
126 | |||
127 | /* VS1 grounded, VS2 float */ | ||
128 | [IN_VS2] = (CARD_PCCARD | CARD_5V | CARD_3V), | ||
129 | |||
130 | /* VS1 grounded, VS2 grounded */ | ||
131 | [0] = (CARD_PCCARD | CARD_5V | CARD_3V | CARD_XV), | ||
132 | |||
133 | /* VS1 tied to CD1, VS2 float */ | ||
134 | [IN_VS1 | IN_VS2 | IN_CD1_VS1H] = (CARD_CARDBUS | CARD_3V), | ||
135 | |||
136 | /* VS1 grounded, VS2 tied to CD2 */ | ||
137 | [IN_VS2 | IN_CD2_VS2H] = (CARD_CARDBUS | CARD_3V | CARD_XV), | ||
138 | |||
139 | /* VS1 tied to CD2, VS2 grounded */ | ||
140 | [IN_VS1 | IN_CD2_VS1H] = (CARD_CARDBUS | CARD_3V | CARD_XV | CARD_YV), | ||
141 | |||
142 | /* VS1 float, VS2 grounded */ | ||
143 | [IN_VS1] = (CARD_PCCARD | CARD_XV), | ||
144 | |||
145 | /* VS1 float, VS2 tied to CD2 */ | ||
146 | [IN_VS1 | IN_VS2 | IN_CD2_VS2H] = (CARD_CARDBUS | CARD_3V), | ||
147 | |||
148 | /* VS1 float, VS2 tied to CD1 */ | ||
149 | [IN_VS1 | IN_VS2 | IN_CD1_VS2H] = (CARD_CARDBUS | CARD_XV | CARD_YV), | ||
150 | |||
151 | /* VS1 tied to CD2, VS2 float */ | ||
152 | [IN_VS1 | IN_VS2 | IN_CD2_VS1H] = (CARD_CARDBUS | CARD_YV), | ||
153 | |||
154 | /* VS2 grounded, VS1 is tied to CD1, CD2 is grounded */ | ||
155 | [IN_VS1 | IN_CD1_VS1H] = 0, /* ignore cardbay */ | ||
156 | }; | ||
157 | |||
158 | /* | ||
159 | * poll hardware to check card insertion status | ||
160 | */ | ||
161 | static unsigned int __get_socket_status(struct bcm63xx_pcmcia_socket *skt) | ||
162 | { | ||
163 | unsigned int stat; | ||
164 | u32 val; | ||
165 | |||
166 | stat = 0; | ||
167 | |||
168 | /* check CD for card presence */ | ||
169 | val = pcmcia_readl(skt, PCMCIA_C1_REG); | ||
170 | |||
171 | if (!(val & PCMCIA_C1_CD1_MASK) && !(val & PCMCIA_C1_CD2_MASK)) | ||
172 | stat |= SS_DETECT; | ||
173 | |||
174 | /* if new insertion, detect cardtype */ | ||
175 | if ((stat & SS_DETECT) && !skt->card_detected) { | ||
176 | unsigned int stat = 0; | ||
177 | |||
178 | /* float VS1, float VS2 */ | ||
179 | val |= PCMCIA_C1_VS1OE_MASK; | ||
180 | val |= PCMCIA_C1_VS2OE_MASK; | ||
181 | pcmcia_writel(skt, val, PCMCIA_C1_REG); | ||
182 | |||
183 | /* wait for output to stabilize and read VS[12] */ | ||
184 | udelay(10); | ||
185 | val = pcmcia_readl(skt, PCMCIA_C1_REG); | ||
186 | stat |= (val & PCMCIA_C1_VS1_MASK) ? IN_VS1 : 0; | ||
187 | stat |= (val & PCMCIA_C1_VS2_MASK) ? IN_VS2 : 0; | ||
188 | |||
189 | /* drive VS1 low, float VS2 */ | ||
190 | val &= ~PCMCIA_C1_VS1OE_MASK; | ||
191 | val |= PCMCIA_C1_VS2OE_MASK; | ||
192 | pcmcia_writel(skt, val, PCMCIA_C1_REG); | ||
193 | |||
194 | /* wait for output to stabilize and read CD[12] */ | ||
195 | udelay(10); | ||
196 | val = pcmcia_readl(skt, PCMCIA_C1_REG); | ||
197 | stat |= (val & PCMCIA_C1_CD1_MASK) ? IN_CD1_VS2H : 0; | ||
198 | stat |= (val & PCMCIA_C1_CD2_MASK) ? IN_CD2_VS2H : 0; | ||
199 | |||
200 | /* float VS1, drive VS2 low */ | ||
201 | val |= PCMCIA_C1_VS1OE_MASK; | ||
202 | val &= ~PCMCIA_C1_VS2OE_MASK; | ||
203 | pcmcia_writel(skt, val, PCMCIA_C1_REG); | ||
204 | |||
205 | /* wait for output to stabilize and read CD[12] */ | ||
206 | udelay(10); | ||
207 | val = pcmcia_readl(skt, PCMCIA_C1_REG); | ||
208 | stat |= (val & PCMCIA_C1_CD1_MASK) ? IN_CD1_VS1H : 0; | ||
209 | stat |= (val & PCMCIA_C1_CD2_MASK) ? IN_CD2_VS1H : 0; | ||
210 | |||
211 | /* guess cardtype from all this */ | ||
212 | skt->card_type = vscd_to_cardtype[stat]; | ||
213 | if (!skt->card_type) | ||
214 | dev_err(&skt->socket.dev, "unsupported card type\n"); | ||
215 | |||
216 | /* drive both VS pin to 0 again */ | ||
217 | val &= ~(PCMCIA_C1_VS1OE_MASK | PCMCIA_C1_VS2OE_MASK); | ||
218 | |||
219 | /* enable correct logic */ | ||
220 | val &= ~(PCMCIA_C1_EN_PCMCIA_MASK | PCMCIA_C1_EN_CARDBUS_MASK); | ||
221 | if (skt->card_type & CARD_PCCARD) | ||
222 | val |= PCMCIA_C1_EN_PCMCIA_MASK; | ||
223 | else | ||
224 | val |= PCMCIA_C1_EN_CARDBUS_MASK; | ||
225 | |||
226 | pcmcia_writel(skt, val, PCMCIA_C1_REG); | ||
227 | } | ||
228 | skt->card_detected = (stat & SS_DETECT) ? 1 : 0; | ||
229 | |||
230 | /* report card type/voltage */ | ||
231 | if (skt->card_type & CARD_CARDBUS) | ||
232 | stat |= SS_CARDBUS; | ||
233 | if (skt->card_type & CARD_3V) | ||
234 | stat |= SS_3VCARD; | ||
235 | if (skt->card_type & CARD_XV) | ||
236 | stat |= SS_XVCARD; | ||
237 | stat |= SS_POWERON; | ||
238 | |||
239 | if (gpio_get_value(skt->pd->ready_gpio)) | ||
240 | stat |= SS_READY; | ||
241 | |||
242 | return stat; | ||
243 | } | ||
244 | |||
245 | /* | ||
246 | * core request to get current socket status | ||
247 | */ | ||
248 | static int bcm63xx_pcmcia_get_status(struct pcmcia_socket *sock, | ||
249 | unsigned int *status) | ||
250 | { | ||
251 | struct bcm63xx_pcmcia_socket *skt; | ||
252 | |||
253 | skt = sock->driver_data; | ||
254 | |||
255 | spin_lock_bh(&skt->lock); | ||
256 | *status = __get_socket_status(skt); | ||
257 | spin_unlock_bh(&skt->lock); | ||
258 | |||
259 | return 0; | ||
260 | } | ||
261 | |||
262 | /* | ||
263 | * socket polling timer callback | ||
264 | */ | ||
265 | static void bcm63xx_pcmcia_poll(unsigned long data) | ||
266 | { | ||
267 | struct bcm63xx_pcmcia_socket *skt; | ||
268 | unsigned int stat, events; | ||
269 | |||
270 | skt = (struct bcm63xx_pcmcia_socket *)data; | ||
271 | |||
272 | spin_lock_bh(&skt->lock); | ||
273 | |||
274 | stat = __get_socket_status(skt); | ||
275 | |||
276 | /* keep only changed bits, and mask with required one from the | ||
277 | * core */ | ||
278 | events = (stat ^ skt->old_status) & skt->requested_state.csc_mask; | ||
279 | skt->old_status = stat; | ||
280 | spin_unlock_bh(&skt->lock); | ||
281 | |||
282 | if (events) | ||
283 | pcmcia_parse_events(&skt->socket, events); | ||
284 | |||
285 | mod_timer(&skt->timer, | ||
286 | jiffies + msecs_to_jiffies(BCM63XX_PCMCIA_POLL_RATE)); | ||
287 | } | ||
288 | |||
289 | static int bcm63xx_pcmcia_set_io_map(struct pcmcia_socket *sock, | ||
290 | struct pccard_io_map *map) | ||
291 | { | ||
292 | /* this doesn't seem to be called by pcmcia layer if static | ||
293 | * mapping is used */ | ||
294 | return 0; | ||
295 | } | ||
296 | |||
297 | static int bcm63xx_pcmcia_set_mem_map(struct pcmcia_socket *sock, | ||
298 | struct pccard_mem_map *map) | ||
299 | { | ||
300 | struct bcm63xx_pcmcia_socket *skt; | ||
301 | struct resource *res; | ||
302 | |||
303 | skt = sock->driver_data; | ||
304 | if (map->flags & MAP_ATTRIB) | ||
305 | res = skt->attr_res; | ||
306 | else | ||
307 | res = skt->common_res; | ||
308 | |||
309 | map->static_start = res->start + map->card_start; | ||
310 | return 0; | ||
311 | } | ||
312 | |||
313 | static struct pccard_operations bcm63xx_pcmcia_operations = { | ||
314 | .init = bcm63xx_pcmcia_sock_init, | ||
315 | .suspend = bcm63xx_pcmcia_suspend, | ||
316 | .get_status = bcm63xx_pcmcia_get_status, | ||
317 | .set_socket = bcm63xx_pcmcia_set_socket, | ||
318 | .set_io_map = bcm63xx_pcmcia_set_io_map, | ||
319 | .set_mem_map = bcm63xx_pcmcia_set_mem_map, | ||
320 | }; | ||
321 | |||
322 | /* | ||
323 | * register pcmcia socket to core | ||
324 | */ | ||
325 | static int __devinit bcm63xx_drv_pcmcia_probe(struct platform_device *pdev) | ||
326 | { | ||
327 | struct bcm63xx_pcmcia_socket *skt; | ||
328 | struct pcmcia_socket *sock; | ||
329 | struct resource *res, *irq_res; | ||
330 | unsigned int regmem_size = 0, iomem_size = 0; | ||
331 | u32 val; | ||
332 | int ret; | ||
333 | |||
334 | skt = kzalloc(sizeof(*skt), GFP_KERNEL); | ||
335 | if (!skt) | ||
336 | return -ENOMEM; | ||
337 | spin_lock_init(&skt->lock); | ||
338 | sock = &skt->socket; | ||
339 | sock->driver_data = skt; | ||
340 | |||
341 | /* make sure we have all resources we need */ | ||
342 | skt->common_res = platform_get_resource(pdev, IORESOURCE_MEM, 1); | ||
343 | skt->attr_res = platform_get_resource(pdev, IORESOURCE_MEM, 2); | ||
344 | irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); | ||
345 | skt->pd = pdev->dev.platform_data; | ||
346 | if (!skt->common_res || !skt->attr_res || !irq_res || !skt->pd) { | ||
347 | ret = -EINVAL; | ||
348 | goto err; | ||
349 | } | ||
350 | |||
351 | /* remap pcmcia registers */ | ||
352 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
353 | regmem_size = resource_size(res); | ||
354 | if (!request_mem_region(res->start, regmem_size, "bcm63xx_pcmcia")) { | ||
355 | ret = -EINVAL; | ||
356 | goto err; | ||
357 | } | ||
358 | skt->reg_res = res; | ||
359 | |||
360 | skt->base = ioremap(res->start, regmem_size); | ||
361 | if (!skt->base) { | ||
362 | ret = -ENOMEM; | ||
363 | goto err; | ||
364 | } | ||
365 | |||
366 | /* remap io registers */ | ||
367 | res = platform_get_resource(pdev, IORESOURCE_MEM, 3); | ||
368 | iomem_size = resource_size(res); | ||
369 | skt->io_base = ioremap(res->start, iomem_size); | ||
370 | if (!skt->io_base) { | ||
371 | ret = -ENOMEM; | ||
372 | goto err; | ||
373 | } | ||
374 | |||
375 | /* resources are static */ | ||
376 | sock->resource_ops = &pccard_static_ops; | ||
377 | sock->ops = &bcm63xx_pcmcia_operations; | ||
378 | sock->owner = THIS_MODULE; | ||
379 | sock->dev.parent = &pdev->dev; | ||
380 | sock->features = SS_CAP_STATIC_MAP | SS_CAP_PCCARD; | ||
381 | sock->io_offset = (unsigned long)skt->io_base; | ||
382 | sock->pci_irq = irq_res->start; | ||
383 | |||
384 | #ifdef CONFIG_CARDBUS | ||
385 | sock->cb_dev = bcm63xx_cb_dev; | ||
386 | if (bcm63xx_cb_dev) | ||
387 | sock->features |= SS_CAP_CARDBUS; | ||
388 | #endif | ||
389 | |||
390 | /* assume common & attribute memory have the same size */ | ||
391 | sock->map_size = resource_size(skt->common_res); | ||
392 | |||
393 | /* initialize polling timer */ | ||
394 | setup_timer(&skt->timer, bcm63xx_pcmcia_poll, (unsigned long)skt); | ||
395 | |||
396 | /* initialize pcmcia control register, drive VS[12] to 0, | ||
397 | * leave CB IDSEL to the old value since it is set by the PCI | ||
398 | * layer */ | ||
399 | val = pcmcia_readl(skt, PCMCIA_C1_REG); | ||
400 | val &= PCMCIA_C1_CBIDSEL_MASK; | ||
401 | val |= PCMCIA_C1_EN_PCMCIA_GPIO_MASK; | ||
402 | pcmcia_writel(skt, val, PCMCIA_C1_REG); | ||
403 | |||
404 | /* | ||
405 | * Hardware has only one set of timings registers, not one for | ||
406 | * each memory access type, so we configure them for the | ||
407 | * slowest one: attribute memory. | ||
408 | */ | ||
409 | val = PCMCIA_C2_DATA16_MASK; | ||
410 | val |= 10 << PCMCIA_C2_RWCOUNT_SHIFT; | ||
411 | val |= 6 << PCMCIA_C2_INACTIVE_SHIFT; | ||
412 | val |= 3 << PCMCIA_C2_SETUP_SHIFT; | ||
413 | val |= 3 << PCMCIA_C2_HOLD_SHIFT; | ||
414 | pcmcia_writel(skt, val, PCMCIA_C2_REG); | ||
415 | |||
416 | ret = pcmcia_register_socket(sock); | ||
417 | if (ret) | ||
418 | goto err; | ||
419 | |||
420 | /* start polling socket */ | ||
421 | mod_timer(&skt->timer, | ||
422 | jiffies + msecs_to_jiffies(BCM63XX_PCMCIA_POLL_RATE)); | ||
423 | |||
424 | platform_set_drvdata(pdev, skt); | ||
425 | return 0; | ||
426 | |||
427 | err: | ||
428 | if (skt->io_base) | ||
429 | iounmap(skt->io_base); | ||
430 | if (skt->base) | ||
431 | iounmap(skt->base); | ||
432 | if (skt->reg_res) | ||
433 | release_mem_region(skt->reg_res->start, regmem_size); | ||
434 | kfree(skt); | ||
435 | return ret; | ||
436 | } | ||
437 | |||
438 | static int __devexit bcm63xx_drv_pcmcia_remove(struct platform_device *pdev) | ||
439 | { | ||
440 | struct bcm63xx_pcmcia_socket *skt; | ||
441 | struct resource *res; | ||
442 | |||
443 | skt = platform_get_drvdata(pdev); | ||
444 | del_timer_sync(&skt->timer); | ||
445 | iounmap(skt->base); | ||
446 | iounmap(skt->io_base); | ||
447 | res = skt->reg_res; | ||
448 | release_mem_region(res->start, resource_size(res)); | ||
449 | kfree(skt); | ||
450 | return 0; | ||
451 | } | ||
452 | |||
453 | struct platform_driver bcm63xx_pcmcia_driver = { | ||
454 | .probe = bcm63xx_drv_pcmcia_probe, | ||
455 | .remove = __devexit_p(bcm63xx_drv_pcmcia_remove), | ||
456 | .driver = { | ||
457 | .name = "bcm63xx_pcmcia", | ||
458 | .owner = THIS_MODULE, | ||
459 | }, | ||
460 | }; | ||
461 | |||
462 | #ifdef CONFIG_CARDBUS | ||
463 | static int __devinit bcm63xx_cb_probe(struct pci_dev *dev, | ||
464 | const struct pci_device_id *id) | ||
465 | { | ||
466 | /* keep pci device */ | ||
467 | bcm63xx_cb_dev = dev; | ||
468 | return platform_driver_register(&bcm63xx_pcmcia_driver); | ||
469 | } | ||
470 | |||
471 | static void __devexit bcm63xx_cb_exit(struct pci_dev *dev) | ||
472 | { | ||
473 | platform_driver_unregister(&bcm63xx_pcmcia_driver); | ||
474 | bcm63xx_cb_dev = NULL; | ||
475 | } | ||
476 | |||
477 | static struct pci_device_id bcm63xx_cb_table[] = { | ||
478 | { | ||
479 | .vendor = PCI_VENDOR_ID_BROADCOM, | ||
480 | .device = BCM6348_CPU_ID, | ||
481 | .subvendor = PCI_VENDOR_ID_BROADCOM, | ||
482 | .subdevice = PCI_ANY_ID, | ||
483 | .class = PCI_CLASS_BRIDGE_CARDBUS << 8, | ||
484 | .class_mask = ~0, | ||
485 | }, | ||
486 | |||
487 | { | ||
488 | .vendor = PCI_VENDOR_ID_BROADCOM, | ||
489 | .device = BCM6358_CPU_ID, | ||
490 | .subvendor = PCI_VENDOR_ID_BROADCOM, | ||
491 | .subdevice = PCI_ANY_ID, | ||
492 | .class = PCI_CLASS_BRIDGE_CARDBUS << 8, | ||
493 | .class_mask = ~0, | ||
494 | }, | ||
495 | |||
496 | { }, | ||
497 | }; | ||
498 | |||
499 | MODULE_DEVICE_TABLE(pci, bcm63xx_cb_table); | ||
500 | |||
501 | static struct pci_driver bcm63xx_cardbus_driver = { | ||
502 | .name = "bcm63xx_cardbus", | ||
503 | .id_table = bcm63xx_cb_table, | ||
504 | .probe = bcm63xx_cb_probe, | ||
505 | .remove = __devexit_p(bcm63xx_cb_exit), | ||
506 | }; | ||
507 | #endif | ||
508 | |||
509 | /* | ||
510 | * if cardbus support is enabled, register our platform device after | ||
511 | * our fake cardbus bridge has been registered | ||
512 | */ | ||
513 | static int __init bcm63xx_pcmcia_init(void) | ||
514 | { | ||
515 | #ifdef CONFIG_CARDBUS | ||
516 | return pci_register_driver(&bcm63xx_cardbus_driver); | ||
517 | #else | ||
518 | return platform_driver_register(&bcm63xx_pcmcia_driver); | ||
519 | #endif | ||
520 | } | ||
521 | |||
522 | static void __exit bcm63xx_pcmcia_exit(void) | ||
523 | { | ||
524 | #ifdef CONFIG_CARDBUS | ||
525 | return pci_unregister_driver(&bcm63xx_cardbus_driver); | ||
526 | #else | ||
527 | platform_driver_unregister(&bcm63xx_pcmcia_driver); | ||
528 | #endif | ||
529 | } | ||
530 | |||
531 | module_init(bcm63xx_pcmcia_init); | ||
532 | module_exit(bcm63xx_pcmcia_exit); | ||
533 | |||
534 | MODULE_LICENSE("GPL"); | ||
535 | MODULE_AUTHOR("Maxime Bizon <mbizon@freebox.fr>"); | ||
536 | MODULE_DESCRIPTION("Linux PCMCIA Card Services: bcm63xx Socket Controller"); | ||
diff --git a/drivers/pcmcia/bcm63xx_pcmcia.h b/drivers/pcmcia/bcm63xx_pcmcia.h new file mode 100644 index 000000000000..ed957399d863 --- /dev/null +++ b/drivers/pcmcia/bcm63xx_pcmcia.h | |||
@@ -0,0 +1,60 @@ | |||
1 | #ifndef BCM63XX_PCMCIA_H_ | ||
2 | #define BCM63XX_PCMCIA_H_ | ||
3 | |||
4 | #include <linux/types.h> | ||
5 | #include <linux/timer.h> | ||
6 | #include <pcmcia/ss.h> | ||
7 | #include <bcm63xx_dev_pcmcia.h> | ||
8 | |||
9 | /* socket polling rate in ms */ | ||
10 | #define BCM63XX_PCMCIA_POLL_RATE 500 | ||
11 | |||
12 | enum { | ||
13 | CARD_CARDBUS = (1 << 0), | ||
14 | CARD_PCCARD = (1 << 1), | ||
15 | CARD_5V = (1 << 2), | ||
16 | CARD_3V = (1 << 3), | ||
17 | CARD_XV = (1 << 4), | ||
18 | CARD_YV = (1 << 5), | ||
19 | }; | ||
20 | |||
21 | struct bcm63xx_pcmcia_socket { | ||
22 | struct pcmcia_socket socket; | ||
23 | |||
24 | /* platform specific data */ | ||
25 | struct bcm63xx_pcmcia_platform_data *pd; | ||
26 | |||
27 | /* all regs access are protected by this spinlock */ | ||
28 | spinlock_t lock; | ||
29 | |||
30 | /* pcmcia registers resource */ | ||
31 | struct resource *reg_res; | ||
32 | |||
33 | /* base remapped address of registers */ | ||
34 | void __iomem *base; | ||
35 | |||
36 | /* whether a card is detected at the moment */ | ||
37 | int card_detected; | ||
38 | |||
39 | /* type of detected card (mask of above enum) */ | ||
40 | u8 card_type; | ||
41 | |||
42 | /* keep last socket status to implement event reporting */ | ||
43 | unsigned int old_status; | ||
44 | |||
45 | /* backup of requested socket state */ | ||
46 | socket_state_t requested_state; | ||
47 | |||
48 | /* timer used for socket status polling */ | ||
49 | struct timer_list timer; | ||
50 | |||
51 | /* attribute/common memory resources */ | ||
52 | struct resource *attr_res; | ||
53 | struct resource *common_res; | ||
54 | struct resource *io_res; | ||
55 | |||
56 | /* base address of io memory */ | ||
57 | void __iomem *io_base; | ||
58 | }; | ||
59 | |||
60 | #endif /* BCM63XX_PCMCIA_H_ */ | ||