Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

at v3.1 162 lines 4.1 kB view raw
1/* 2 * linux/drivers/pcmcia/pxa2xx_stargate2.c 3 * 4 * Stargate 2 PCMCIA specific routines. 5 * 6 * Created: December 6, 2005 7 * Author: Ed C. Epp 8 * Copyright: Intel Corp 2005 9 * Jonathan Cameron <jic23@cam.ac.uk> 2009 10 * 11 * This program is free software; you can redistribute it and/or modify 12 * it under the terms of the GNU General Public License version 2 as 13 * published by the Free Software Foundation. 14 */ 15 16#include <linux/module.h> 17#include <linux/init.h> 18#include <linux/kernel.h> 19#include <linux/interrupt.h> 20#include <linux/delay.h> 21#include <linux/platform_device.h> 22#include <linux/gpio.h> 23 24#include <pcmcia/ss.h> 25 26#include <asm/irq.h> 27#include <asm/mach-types.h> 28 29#include "soc_common.h" 30 31#define SG2_S0_POWER_CTL 108 32#define SG2_S0_GPIO_RESET 82 33#define SG2_S0_GPIO_DETECT 53 34#define SG2_S0_GPIO_READY 81 35 36static struct pcmcia_irqs irqs[] = { 37 { 0, IRQ_GPIO(SG2_S0_GPIO_DETECT), "PCMCIA0 CD" }, 38}; 39 40static struct gpio sg2_pcmcia_gpios[] = { 41 { SG2_S0_GPIO_RESET, GPIOF_OUT_INIT_HIGH, "PCMCIA Reset" }, 42 { SG2_S0_POWER_CTL, GPIOF_OUT_INIT_HIGH, "PCMCIA Power Ctrl" }, 43}; 44 45static int sg2_pcmcia_hw_init(struct soc_pcmcia_socket *skt) 46{ 47 skt->socket.pci_irq = IRQ_GPIO(SG2_S0_GPIO_READY); 48 return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs)); 49} 50 51static void sg2_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt) 52{ 53 soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs)); 54} 55 56static void sg2_pcmcia_socket_state(struct soc_pcmcia_socket *skt, 57 struct pcmcia_state *state) 58{ 59 state->detect = !gpio_get_value(SG2_S0_GPIO_DETECT); 60 state->ready = !!gpio_get_value(SG2_S0_GPIO_READY); 61 state->bvd1 = 0; /* not available - battery detect on card */ 62 state->bvd2 = 0; /* not available */ 63 state->vs_3v = 1; /* not available - voltage detect for card */ 64 state->vs_Xv = 0; /* not available */ 65 state->wrprot = 0; /* not available - write protect */ 66} 67 68static int sg2_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, 69 const socket_state_t *state) 70{ 71 /* Enable card power */ 72 switch (state->Vcc) { 73 case 0: 74 /* sets power ctl register high */ 75 gpio_set_value(SG2_S0_POWER_CTL, 1); 76 break; 77 case 33: 78 case 50: 79 /* sets power control register low (clear) */ 80 gpio_set_value(SG2_S0_POWER_CTL, 0); 81 msleep(100); 82 break; 83 default: 84 pr_err("%s(): bad Vcc %u\n", 85 __func__, state->Vcc); 86 return -1; 87 } 88 89 /* reset */ 90 gpio_set_value(SG2_S0_GPIO_RESET, !!(state->flags & SS_RESET)); 91 92 return 0; 93} 94 95static void sg2_pcmcia_socket_init(struct soc_pcmcia_socket *skt) 96{ 97 soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs)); 98} 99 100static void sg2_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt) 101{ 102 soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs)); 103} 104 105static struct pcmcia_low_level sg2_pcmcia_ops __initdata = { 106 .owner = THIS_MODULE, 107 .hw_init = sg2_pcmcia_hw_init, 108 .hw_shutdown = sg2_pcmcia_hw_shutdown, 109 .socket_state = sg2_pcmcia_socket_state, 110 .configure_socket = sg2_pcmcia_configure_socket, 111 .socket_init = sg2_pcmcia_socket_init, 112 .socket_suspend = sg2_pcmcia_socket_suspend, 113 .nr = 1, 114}; 115 116static struct platform_device *sg2_pcmcia_device; 117 118static int __init sg2_pcmcia_init(void) 119{ 120 int ret; 121 122 if (!machine_is_stargate2()) 123 return -ENODEV; 124 125 sg2_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1); 126 if (!sg2_pcmcia_device) 127 return -ENOMEM; 128 129 ret = gpio_request_array(sg2_pcmcia_gpios, ARRAY_SIZE(sg2_pcmcia_gpios)); 130 if (ret) 131 goto error_put_platform_device; 132 133 ret = platform_device_add_data(sg2_pcmcia_device, 134 &sg2_pcmcia_ops, 135 sizeof(sg2_pcmcia_ops)); 136 if (ret) 137 goto error_free_gpios; 138 139 ret = platform_device_add(sg2_pcmcia_device); 140 if (ret) 141 goto error_free_gpios; 142 143 return 0; 144error_free_gpios: 145 gpio_free_array(sg2_pcmcia_gpios, ARRAY_SIZE(sg2_pcmcia_gpios)); 146error_put_platform_device: 147 platform_device_put(sg2_pcmcia_device); 148 149 return ret; 150} 151 152static void __exit sg2_pcmcia_exit(void) 153{ 154 platform_device_unregister(sg2_pcmcia_device); 155 gpio_free_array(sg2_pcmcia_gpios, ARRAY_SIZE(sg2_pcmcia_gpios)); 156} 157 158fs_initcall(sg2_pcmcia_init); 159module_exit(sg2_pcmcia_exit); 160 161MODULE_LICENSE("GPL"); 162MODULE_ALIAS("platform:pxa2xx-pcmcia");