Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 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 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 101 102 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 131 132 133 134 135 136 137 138 139 140 | /* * 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> * * 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/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> #include <asm/mach-types.h> #include "soc_common.h" static int balloon3_pcmcia_hw_init(struct soc_pcmcia_socket *skt) { uint16_t ver; ver = __raw_readw(BALLOON3_FPGA_VER); if (ver < 0x4f08) pr_warn("The FPGA code, version 0x%04x, is too old. " "PCMCIA/CF support might be broken in this version!", ver); skt->socket.pci_irq = BALLOON3_BP_CF_NRDY_IRQ; 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"; return 0; } 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); } 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 */ } static int balloon3_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state) { __raw_writew(BALLOON3_CF_RESET, BALLOON3_CF_CONTROL_REG + ((state->flags & SS_RESET) ? BALLOON3_FPGA_SETnCLR : 0)); return 0; } static struct pcmcia_low_level balloon3_pcmcia_ops = { .owner = THIS_MODULE, .hw_init = balloon3_pcmcia_hw_init, .socket_state = balloon3_pcmcia_socket_state, .configure_socket = balloon3_pcmcia_configure_socket, .first = 0, .nr = 1, }; static struct platform_device *balloon3_pcmcia_device; static int __init balloon3_pcmcia_init(void) { int ret; if (!machine_is_balloon3()) return -ENODEV; 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"); |