Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
1da177e4 LT |
2 | /* |
3 | * linux/drivers/pcmcia/pxa2xx_mainstone.c | |
4 | * | |
5 | * Mainstone PCMCIA specific routines. | |
6 | * | |
7 | * Created: May 12, 2004 | |
8 | * Author: Nicolas Pitre | |
9 | * Copyright: MontaVista Software Inc. | |
1da177e4 | 10 | */ |
34fdbe64 | 11 | #include <linux/gpio/consumer.h> |
1da177e4 LT |
12 | #include <linux/module.h> |
13 | #include <linux/init.h> | |
34fdbe64 | 14 | #include <linux/interrupt.h> |
1da177e4 LT |
15 | #include <linux/kernel.h> |
16 | #include <linux/errno.h> | |
d052d1be | 17 | #include <linux/platform_device.h> |
1da177e4 LT |
18 | |
19 | #include <pcmcia/ss.h> | |
20 | ||
04ba0f65 | 21 | #include <asm/mach-types.h> |
1da177e4 LT |
22 | |
23 | #include "soc_common.h" | |
34fdbe64 | 24 | #include "max1600.h" |
1da177e4 | 25 | |
1da177e4 LT |
26 | static int mst_pcmcia_hw_init(struct soc_pcmcia_socket *skt) |
27 | { | |
34fdbe64 RK |
28 | struct device *dev = skt->socket.dev.parent; |
29 | struct max1600 *m; | |
30 | int ret; | |
31 | ||
32 | skt->stat[SOC_STAT_CD].name = skt->nr ? "bdetect" : "adetect"; | |
33 | skt->stat[SOC_STAT_BVD1].name = skt->nr ? "bbvd1" : "abvd1"; | |
34 | skt->stat[SOC_STAT_BVD2].name = skt->nr ? "bbvd2" : "abvd2"; | |
35 | skt->stat[SOC_STAT_RDY].name = skt->nr ? "bready" : "aready"; | |
36 | skt->stat[SOC_STAT_VS1].name = skt->nr ? "bvs1" : "avs1"; | |
37 | skt->stat[SOC_STAT_VS2].name = skt->nr ? "bvs2" : "avs2"; | |
38 | ||
39 | skt->gpio_reset = devm_gpiod_get(dev, skt->nr ? "breset" : "areset", | |
40 | GPIOD_OUT_HIGH); | |
41 | if (IS_ERR(skt->gpio_reset)) | |
42 | return PTR_ERR(skt->gpio_reset); | |
43 | ||
44 | ret = max1600_init(dev, &m, skt->nr ? MAX1600_CHAN_B : MAX1600_CHAN_A, | |
45 | MAX1600_CODE_HIGH); | |
46 | if (ret) | |
47 | return ret; | |
48 | ||
49 | skt->driver_data = m; | |
50 | ||
51 | return soc_pcmcia_request_gpiods(skt); | |
1da177e4 LT |
52 | } |
53 | ||
34fdbe64 | 54 | static unsigned int mst_pcmcia_bvd1_status[2]; |
1da177e4 LT |
55 | |
56 | static void mst_pcmcia_socket_state(struct soc_pcmcia_socket *skt, | |
57 | struct pcmcia_state *state) | |
58 | { | |
34fdbe64 | 59 | unsigned int flip = mst_pcmcia_bvd1_status[skt->nr] ^ state->bvd1; |
1da177e4 LT |
60 | |
61 | /* | |
62 | * Workaround for STSCHG which can't be deasserted: | |
63 | * We therefore disable/enable corresponding IRQs | |
64 | * as needed to avoid IRQ locks. | |
65 | */ | |
66 | if (flip) { | |
34fdbe64 RK |
67 | mst_pcmcia_bvd1_status[skt->nr] = state->bvd1; |
68 | if (state->bvd1) | |
69 | enable_irq(skt->stat[SOC_STAT_BVD1].irq); | |
1da177e4 | 70 | else |
34fdbe64 | 71 | disable_irq(skt->stat[SOC_STAT_BVD2].irq); |
1da177e4 | 72 | } |
1da177e4 LT |
73 | } |
74 | ||
75 | static int mst_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, | |
76 | const socket_state_t *state) | |
77 | { | |
34fdbe64 | 78 | return max1600_configure(skt->driver_data, state->Vcc, state->Vpp); |
1da177e4 LT |
79 | } |
80 | ||
4e5e8de0 | 81 | static struct pcmcia_low_level mst_pcmcia_ops __initdata = { |
1da177e4 LT |
82 | .owner = THIS_MODULE, |
83 | .hw_init = mst_pcmcia_hw_init, | |
1da177e4 LT |
84 | .socket_state = mst_pcmcia_socket_state, |
85 | .configure_socket = mst_pcmcia_configure_socket, | |
1da177e4 LT |
86 | .nr = 2, |
87 | }; | |
88 | ||
89 | static struct platform_device *mst_pcmcia_device; | |
90 | ||
91 | static int __init mst_pcmcia_init(void) | |
92 | { | |
93 | int ret; | |
94 | ||
04ba0f65 RK |
95 | if (!machine_is_mainstone()) |
96 | return -ENODEV; | |
97 | ||
b016450f | 98 | mst_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1); |
1da177e4 LT |
99 | if (!mst_pcmcia_device) |
100 | return -ENOMEM; | |
b016450f | 101 | |
4e5e8de0 RK |
102 | ret = platform_device_add_data(mst_pcmcia_device, &mst_pcmcia_ops, |
103 | sizeof(mst_pcmcia_ops)); | |
104 | if (ret == 0) | |
105 | ret = platform_device_add(mst_pcmcia_device); | |
b016450f | 106 | |
1da177e4 | 107 | if (ret) |
b016450f | 108 | platform_device_put(mst_pcmcia_device); |
1da177e4 LT |
109 | |
110 | return ret; | |
111 | } | |
112 | ||
113 | static void __exit mst_pcmcia_exit(void) | |
114 | { | |
1da177e4 LT |
115 | platform_device_unregister(mst_pcmcia_device); |
116 | } | |
117 | ||
f36598ae | 118 | fs_initcall(mst_pcmcia_init); |
1da177e4 LT |
119 | module_exit(mst_pcmcia_exit); |
120 | ||
121 | MODULE_LICENSE("GPL"); | |
43cc71ee | 122 | MODULE_ALIAS("platform:pxa2xx-pcmcia"); |