123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140 |
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/kernel.h>
- #include <linux/interrupt.h>
- #include <linux/delay.h>
- #include <linux/platform_device.h>
- #include <linux/gpio.h>
- #include <pcmcia/ss.h>
- #include <asm/irq.h>
- #include <asm/mach-types.h>
- #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;
- state->bvd2 = 0;
- state->vs_3v = 1;
- state->vs_Xv = 0;
- }
- static int sg2_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
- const socket_state_t *state)
- {
-
- switch (state->Vcc) {
- case 0:
-
- gpio_set_value(SG2_S0_POWER_CTL, 1);
- break;
- case 33:
- case 50:
-
- gpio_set_value(SG2_S0_POWER_CTL, 0);
- msleep(100);
- break;
- default:
- pr_err("%s(): bad Vcc %u\n",
- __func__, state->Vcc);
- return -1;
- }
-
- 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");
|