Blame view
drivers/pcmcia/pxa2xx_balloon3.c
3.43 KB
d2912cb15
|
1 |
// SPDX-License-Identifier: GPL-2.0-only |
a9c0629cd
|
2 3 4 5 6 7 8 9 10 11 12 |
/* * linux/drivers/pcmcia/pxa2xx_balloon3.c * * Balloon3 PCMCIA specific routines. * * Author: Nick Bane * Created: June, 2006 * Copyright: Toby Churchill Ltd * Derived from pxa2xx_mainstone.c, by Nico Pitre * * Various modification by Marek Vasut <marek.vasut@gmail.com> |
a9c0629cd
|
13 14 15 16 17 18 19 20 21 22 23 |
*/ #include <linux/module.h> #include <linux/gpio.h> #include <linux/errno.h> #include <linux/interrupt.h> #include <linux/platform_device.h> #include <linux/irq.h> #include <linux/io.h> #include <mach/balloon3.h> |
af21cbb1e
|
24 |
#include <asm/mach-types.h> |
a9c0629cd
|
25 |
#include "soc_common.h" |
a9c0629cd
|
26 27 28 |
static int balloon3_pcmcia_hw_init(struct soc_pcmcia_socket *skt) { uint16_t ver; |
a9c0629cd
|
29 30 |
ver = __raw_readw(BALLOON3_FPGA_VER); |
1b9169d8a
|
31 32 |
if (ver < 0x4f08) pr_warn("The FPGA code, version 0x%04x, is too old. " |
a9c0629cd
|
33 34 35 36 |
"PCMCIA/CF support might be broken in this version!", ver); skt->socket.pci_irq = BALLOON3_BP_CF_NRDY_IRQ; |
a9bb5a4bf
|
37 38 39 40 |
skt->stat[SOC_STAT_CD].gpio = BALLOON3_GPIO_S0_CD; skt->stat[SOC_STAT_CD].name = "PCMCIA0 CD"; skt->stat[SOC_STAT_BVD1].irq = BALLOON3_BP_NSTSCHG_IRQ; skt->stat[SOC_STAT_BVD1].name = "PCMCIA0 STSCHG"; |
a9c0629cd
|
41 |
|
a9bb5a4bf
|
42 |
return 0; |
a9c0629cd
|
43 44 45 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 |
} static unsigned long balloon3_pcmcia_status[2] = { BALLOON3_CF_nSTSCHG_BVD1, BALLOON3_CF_nSTSCHG_BVD1 }; static void balloon3_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state) { uint16_t status; int flip; /* This actually reads the STATUS register */ status = __raw_readw(BALLOON3_CF_STATUS_REG); flip = (status ^ balloon3_pcmcia_status[skt->nr]) & BALLOON3_CF_nSTSCHG_BVD1; /* * Workaround for STSCHG which can't be deasserted: * We therefore disable/enable corresponding IRQs * as needed to avoid IRQ locks. */ if (flip) { balloon3_pcmcia_status[skt->nr] = status; if (status & BALLOON3_CF_nSTSCHG_BVD1) enable_irq(BALLOON3_BP_NSTSCHG_IRQ); else disable_irq(BALLOON3_BP_NSTSCHG_IRQ); } |
a9c0629cd
|
72 73 74 75 76 |
state->ready = !!(status & BALLOON3_CF_nIRQ); state->bvd1 = !!(status & BALLOON3_CF_nSTSCHG_BVD1); state->bvd2 = 0; /* not available */ state->vs_3v = 1; /* Always true its a CF card */ state->vs_Xv = 0; /* not available */ |
a9c0629cd
|
77 78 79 80 81 |
} static int balloon3_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state) { |
97b09da4e
|
82 |
__raw_writew(BALLOON3_CF_RESET, BALLOON3_CF_CONTROL_REG + |
1b9169d8a
|
83 84 |
((state->flags & SS_RESET) ? BALLOON3_FPGA_SETnCLR : 0)); |
a9c0629cd
|
85 86 |
return 0; } |
a9c0629cd
|
87 88 89 |
static struct pcmcia_low_level balloon3_pcmcia_ops = { .owner = THIS_MODULE, .hw_init = balloon3_pcmcia_hw_init, |
a9c0629cd
|
90 91 |
.socket_state = balloon3_pcmcia_socket_state, .configure_socket = balloon3_pcmcia_configure_socket, |
a9c0629cd
|
92 93 94 95 96 97 98 99 100 |
.first = 0, .nr = 1, }; static struct platform_device *balloon3_pcmcia_device; static int __init balloon3_pcmcia_init(void) { int ret; |
af21cbb1e
|
101 102 |
if (!machine_is_balloon3()) return -ENODEV; |
a9c0629cd
|
103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 |
balloon3_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1); if (!balloon3_pcmcia_device) return -ENOMEM; ret = platform_device_add_data(balloon3_pcmcia_device, &balloon3_pcmcia_ops, sizeof(balloon3_pcmcia_ops)); if (!ret) ret = platform_device_add(balloon3_pcmcia_device); if (ret) platform_device_put(balloon3_pcmcia_device); return ret; } static void __exit balloon3_pcmcia_exit(void) { platform_device_unregister(balloon3_pcmcia_device); } module_init(balloon3_pcmcia_init); module_exit(balloon3_pcmcia_exit); MODULE_LICENSE("GPL"); MODULE_AUTHOR("Nick Bane <nick@cecomputing.co.uk>"); MODULE_ALIAS("platform:pxa2xx-pcmcia"); MODULE_DESCRIPTION("Balloon3 board CF/PCMCIA driver"); |