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