Blame view
drivers/pcmcia/pxa2xx_mainstone.c
4.29 KB
1da177e4c Linux-2.6.12-rc2 |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 |
/* * linux/drivers/pcmcia/pxa2xx_mainstone.c * * Mainstone PCMCIA specific routines. * * Created: May 12, 2004 * Author: Nicolas Pitre * Copyright: MontaVista Software Inc. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ #include <linux/module.h> #include <linux/init.h> #include <linux/kernel.h> #include <linux/errno.h> #include <linux/interrupt.h> |
d052d1bef Create platform_d... |
20 |
#include <linux/platform_device.h> |
1da177e4c Linux-2.6.12-rc2 |
21 22 |
#include <pcmcia/ss.h> |
04ba0f656 [ARM] pxa: avoid ... |
23 |
#include <asm/mach-types.h> |
1da177e4c Linux-2.6.12-rc2 |
24 |
#include <asm/irq.h> |
b74d19690 [ARM] pxa: move p... |
25 |
#include <mach/pxa2xx-regs.h> |
a09e64fbc [ARM] Move includ... |
26 |
#include <mach/mainstone.h> |
1da177e4c Linux-2.6.12-rc2 |
27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 |
#include "soc_common.h" static struct pcmcia_irqs irqs[] = { { 0, MAINSTONE_S0_CD_IRQ, "PCMCIA0 CD" }, { 1, MAINSTONE_S1_CD_IRQ, "PCMCIA1 CD" }, { 0, MAINSTONE_S0_STSCHG_IRQ, "PCMCIA0 STSCHG" }, { 1, MAINSTONE_S1_STSCHG_IRQ, "PCMCIA1 STSCHG" }, }; static int mst_pcmcia_hw_init(struct soc_pcmcia_socket *skt) { /* * Setup default state of GPIO outputs * before we enable them as outputs. */ |
1da177e4c Linux-2.6.12-rc2 |
44 |
|
66024db57 PCMCIA: stop dupl... |
45 |
skt->socket.pci_irq = (skt->nr == 0) ? MAINSTONE_S0_IRQ : MAINSTONE_S1_IRQ; |
1da177e4c Linux-2.6.12-rc2 |
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 |
return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs)); } static void mst_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt) { soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs)); } static unsigned long mst_pcmcia_status[2]; static void mst_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state) { unsigned long status, flip; status = (skt->nr == 0) ? MST_PCMCIA0 : MST_PCMCIA1; flip = (status ^ mst_pcmcia_status[skt->nr]) & MST_PCMCIA_nSTSCHG_BVD1; /* * Workaround for STSCHG which can't be deasserted: * We therefore disable/enable corresponding IRQs * as needed to avoid IRQ locks. */ if (flip) { mst_pcmcia_status[skt->nr] = status; if (status & MST_PCMCIA_nSTSCHG_BVD1) enable_irq( (skt->nr == 0) ? MAINSTONE_S0_STSCHG_IRQ : MAINSTONE_S1_STSCHG_IRQ ); else disable_irq( (skt->nr == 0) ? MAINSTONE_S0_STSCHG_IRQ : MAINSTONE_S1_STSCHG_IRQ ); } state->detect = (status & MST_PCMCIA_nCD) ? 0 : 1; state->ready = (status & MST_PCMCIA_nIRQ) ? 1 : 0; state->bvd1 = (status & MST_PCMCIA_nSTSCHG_BVD1) ? 1 : 0; state->bvd2 = (status & MST_PCMCIA_nSPKR_BVD2) ? 1 : 0; state->vs_3v = (status & MST_PCMCIA_nVS1) ? 0 : 1; state->vs_Xv = (status & MST_PCMCIA_nVS2) ? 0 : 1; state->wrprot = 0; /* not available */ } static int mst_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state) { unsigned long power = 0; int ret = 0; switch (state->Vcc) { case 0: power |= MST_PCMCIA_PWR_VCC_0; break; case 33: power |= MST_PCMCIA_PWR_VCC_33; break; case 50: power |= MST_PCMCIA_PWR_VCC_50; break; default: printk(KERN_ERR "%s(): bad Vcc %u ", |
2e11cb4c5 pcmcia: replace r... |
101 |
__func__, state->Vcc); |
1da177e4c Linux-2.6.12-rc2 |
102 103 104 105 106 107 108 109 110 111 112 113 |
ret = -1; } switch (state->Vpp) { case 0: power |= MST_PCMCIA_PWR_VPP_0; break; case 120: power |= MST_PCMCIA_PWR_VPP_120; break; default: if(state->Vpp == state->Vcc) { power |= MST_PCMCIA_PWR_VPP_VCC; } else { printk(KERN_ERR "%s(): bad Vpp %u ", |
2e11cb4c5 pcmcia: replace r... |
114 |
__func__, state->Vpp); |
1da177e4c Linux-2.6.12-rc2 |
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 |
ret = -1; } } if (state->flags & SS_RESET) power |= MST_PCMCIA_RESET; switch (skt->nr) { case 0: MST_PCMCIA0 = power; break; case 1: MST_PCMCIA1 = power; break; default: ret = -1; } return ret; } |
4e5e8de0d [ARM] pxa: avoid ... |
130 |
static struct pcmcia_low_level mst_pcmcia_ops __initdata = { |
1da177e4c Linux-2.6.12-rc2 |
131 132 133 134 135 |
.owner = THIS_MODULE, .hw_init = mst_pcmcia_hw_init, .hw_shutdown = mst_pcmcia_hw_shutdown, .socket_state = mst_pcmcia_socket_state, .configure_socket = mst_pcmcia_configure_socket, |
1da177e4c Linux-2.6.12-rc2 |
136 137 138 139 140 141 142 143 |
.nr = 2, }; static struct platform_device *mst_pcmcia_device; static int __init mst_pcmcia_init(void) { int ret; |
04ba0f656 [ARM] pxa: avoid ... |
144 145 |
if (!machine_is_mainstone()) return -ENODEV; |
b016450f9 [ARM] 3250/1: Cha... |
146 |
mst_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1); |
1da177e4c Linux-2.6.12-rc2 |
147 148 |
if (!mst_pcmcia_device) return -ENOMEM; |
b016450f9 [ARM] 3250/1: Cha... |
149 |
|
4e5e8de0d [ARM] pxa: avoid ... |
150 151 152 153 |
ret = platform_device_add_data(mst_pcmcia_device, &mst_pcmcia_ops, sizeof(mst_pcmcia_ops)); if (ret == 0) ret = platform_device_add(mst_pcmcia_device); |
b016450f9 [ARM] 3250/1: Cha... |
154 |
|
1da177e4c Linux-2.6.12-rc2 |
155 |
if (ret) |
b016450f9 [ARM] 3250/1: Cha... |
156 |
platform_device_put(mst_pcmcia_device); |
1da177e4c Linux-2.6.12-rc2 |
157 158 159 160 161 162 |
return ret; } static void __exit mst_pcmcia_exit(void) { |
1da177e4c Linux-2.6.12-rc2 |
163 164 |
platform_device_unregister(mst_pcmcia_device); } |
f36598aec [ARM] 2873/1: PCM... |
165 |
fs_initcall(mst_pcmcia_init); |
1da177e4c Linux-2.6.12-rc2 |
166 167 168 |
module_exit(mst_pcmcia_exit); MODULE_LICENSE("GPL"); |
43cc71eed platform: prefix ... |
169 |
MODULE_ALIAS("platform:pxa2xx-pcmcia"); |