/* * linux/drivers/pcmcia/pxa2xx_stargate2.c * * Stargate 2 PCMCIA specific routines. * * Created: December 6, 2005 * Author: Ed C. Epp * Copyright: Intel Corp 2005 * Jonathan Cameron 2009 * * 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 #include #include #include #include #include #include #include #include #include #include "soc_common.h" #define SG2_S0_POWER_CTL 108 #define SG2_S0_GPIO_RESET 82 #define SG2_S0_GPIO_DETECT 53 #define SG2_S0_GPIO_READY 81 static struct gpio sg2_pcmcia_gpios[] = { { SG2_S0_GPIO_RESET, GPIOF_OUT_INIT_HIGH, "PCMCIA Reset" }, { SG2_S0_POWER_CTL, GPIOF_OUT_INIT_HIGH, "PCMCIA Power Ctrl" }, }; static int sg2_pcmcia_hw_init(struct soc_pcmcia_socket *skt) { skt->stat[SOC_STAT_CD].gpio = SG2_S0_GPIO_DETECT; skt->stat[SOC_STAT_CD].name = "PCMCIA0 CD"; skt->stat[SOC_STAT_RDY].gpio = SG2_S0_GPIO_READY; skt->stat[SOC_STAT_RDY].name = "PCMCIA0 RDY"; return 0; } static void sg2_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state) { state->bvd1 = 0; /* not available - battery detect on card */ state->bvd2 = 0; /* not available */ state->vs_3v = 1; /* not available - voltage detect for card */ state->vs_Xv = 0; /* not available */ } static int sg2_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state) { /* Enable card power */ switch (state->Vcc) { case 0: /* sets power ctl register high */ gpio_set_value(SG2_S0_POWER_CTL, 1); break; case 33: case 50: /* sets power control register low (clear) */ gpio_set_value(SG2_S0_POWER_CTL, 0); msleep(100); break; default: pr_err("%s(): bad Vcc %u\n", __func__, state->Vcc); return -1; } /* reset */ gpio_set_value(SG2_S0_GPIO_RESET, !!(state->flags & SS_RESET)); return 0; } static struct pcmcia_low_level sg2_pcmcia_ops __initdata = { .owner = THIS_MODULE, .hw_init = sg2_pcmcia_hw_init, .socket_state = sg2_pcmcia_socket_state, .configure_socket = sg2_pcmcia_configure_socket, .nr = 1, }; static struct platform_device *sg2_pcmcia_device; static int __init sg2_pcmcia_init(void) { int ret; if (!machine_is_stargate2()) return -ENODEV; sg2_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1); if (!sg2_pcmcia_device) return -ENOMEM; ret = gpio_request_array(sg2_pcmcia_gpios, ARRAY_SIZE(sg2_pcmcia_gpios)); if (ret) goto error_put_platform_device; ret = platform_device_add_data(sg2_pcmcia_device, &sg2_pcmcia_ops, sizeof(sg2_pcmcia_ops)); if (ret) goto error_free_gpios; ret = platform_device_add(sg2_pcmcia_device); if (ret) goto error_free_gpios; return 0; error_free_gpios: gpio_free_array(sg2_pcmcia_gpios, ARRAY_SIZE(sg2_pcmcia_gpios)); error_put_platform_device: platform_device_put(sg2_pcmcia_device); return ret; } static void __exit sg2_pcmcia_exit(void) { platform_device_unregister(sg2_pcmcia_device); gpio_free_array(sg2_pcmcia_gpios, ARRAY_SIZE(sg2_pcmcia_gpios)); } fs_initcall(sg2_pcmcia_init); module_exit(sg2_pcmcia_exit); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:pxa2xx-pcmcia");