Root/drivers/pcmcia/pxa2xx_stargate2.c

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_BUFF_CTL 120
32#define SG2_S0_POWER_CTL 108
33#define SG2_S0_GPIO_RESET 82
34#define SG2_S0_GPIO_DETECT 53
35#define SG2_S0_GPIO_READY 81
36
37static struct pcmcia_irqs irqs[] = {
38    { 0, IRQ_GPIO(SG2_S0_GPIO_DETECT), "PCMCIA0 CD" },
39};
40
41static int sg2_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
42{
43    skt->socket.pci_irq = IRQ_GPIO(SG2_S0_GPIO_READY);
44    return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
45}
46
47static void sg2_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
48{
49    soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
50}
51
52static void sg2_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
53                    struct pcmcia_state *state)
54{
55    state->detect = !gpio_get_value(SG2_S0_GPIO_DETECT);
56    state->ready = !!gpio_get_value(SG2_S0_GPIO_READY);
57    state->bvd1 = 0; /* not available - battery detect on card */
58    state->bvd2 = 0; /* not available */
59    state->vs_3v = 1; /* not available - voltage detect for card */
60    state->vs_Xv = 0; /* not available */
61    state->wrprot = 0; /* not available - write protect */
62}
63
64static int sg2_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
65                       const socket_state_t *state)
66{
67    /* Enable card power */
68    switch (state->Vcc) {
69    case 0:
70        /* sets power ctl register high */
71        gpio_set_value(SG2_S0_POWER_CTL, 1);
72        break;
73    case 33:
74    case 50:
75        /* sets power control register low (clear) */
76        gpio_set_value(SG2_S0_POWER_CTL, 0);
77        msleep(100);
78        break;
79    default:
80        pr_err("%s(): bad Vcc %u\n",
81               __func__, state->Vcc);
82        return -1;
83    }
84
85    /* reset */
86    gpio_set_value(SG2_S0_GPIO_RESET, !!(state->flags & SS_RESET));
87
88    return 0;
89}
90
91static void sg2_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
92{
93    soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs));
94}
95
96static void sg2_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
97{
98    soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs));
99}
100
101static struct pcmcia_low_level sg2_pcmcia_ops __initdata = {
102    .owner = THIS_MODULE,
103    .hw_init = sg2_pcmcia_hw_init,
104    .hw_shutdown = sg2_pcmcia_hw_shutdown,
105    .socket_state = sg2_pcmcia_socket_state,
106    .configure_socket = sg2_pcmcia_configure_socket,
107    .socket_init = sg2_pcmcia_socket_init,
108    .socket_suspend = sg2_pcmcia_socket_suspend,
109    .nr = 1,
110};
111
112static struct platform_device *sg2_pcmcia_device;
113
114static int __init sg2_pcmcia_init(void)
115{
116    int ret;
117
118    if (!machine_is_stargate2())
119        return -ENODEV;
120
121    sg2_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
122    if (!sg2_pcmcia_device)
123        return -ENOMEM;
124
125    ret = gpio_request(SG2_S0_BUFF_CTL, "SG2 CF buff ctl");
126    if (ret)
127        goto error_put_platform_device;
128    ret = gpio_request(SG2_S0_POWER_CTL, "SG2 CF power ctl");
129    if (ret)
130        goto error_free_gpio_buff_ctl;
131    ret = gpio_request(SG2_S0_GPIO_RESET, "SG2 CF reset");
132    if (ret)
133        goto error_free_gpio_power_ctl;
134    /* Set gpio directions */
135    gpio_direction_output(SG2_S0_BUFF_CTL, 0);
136    gpio_direction_output(SG2_S0_POWER_CTL, 1);
137    gpio_direction_output(SG2_S0_GPIO_RESET, 1);
138
139    ret = platform_device_add_data(sg2_pcmcia_device,
140                       &sg2_pcmcia_ops,
141                       sizeof(sg2_pcmcia_ops));
142    if (ret)
143        goto error_free_gpio_reset;
144
145    ret = platform_device_add(sg2_pcmcia_device);
146    if (ret)
147        goto error_free_gpio_reset;
148
149    return 0;
150error_free_gpio_reset:
151    gpio_free(SG2_S0_GPIO_RESET);
152error_free_gpio_power_ctl:
153    gpio_free(SG2_S0_POWER_CTL);
154error_free_gpio_buff_ctl:
155    gpio_free(SG2_S0_BUFF_CTL);
156error_put_platform_device:
157    platform_device_put(sg2_pcmcia_device);
158
159    return ret;
160}
161
162static void __exit sg2_pcmcia_exit(void)
163{
164    platform_device_unregister(sg2_pcmcia_device);
165    gpio_free(SG2_S0_BUFF_CTL);
166    gpio_free(SG2_S0_POWER_CTL);
167    gpio_free(SG2_S0_GPIO_RESET);
168}
169
170fs_initcall(sg2_pcmcia_init);
171module_exit(sg2_pcmcia_exit);
172
173MODULE_LICENSE("GPL");
174MODULE_ALIAS("platform:pxa2xx-pcmcia");
175

Archive Download this file



interactive