treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / pcmcia / pxa2xx_cm_x255.c
blobc0b6b846fbaa98381281d4178bbed8427d268f42
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * linux/drivers/pcmcia/pxa/pxa_cm_x255.c
5 * Compulab Ltd., 2003, 2007, 2008
6 * Mike Rapoport <mike@compulab.co.il>
7 */
9 #include <linux/platform_device.h>
10 #include <linux/irq.h>
11 #include <linux/delay.h>
12 #include <linux/gpio.h>
13 #include <linux/export.h>
15 #include "soc_common.h"
17 #define GPIO_PCMCIA_SKTSEL (54)
18 #define GPIO_PCMCIA_S0_CD_VALID (16)
19 #define GPIO_PCMCIA_S1_CD_VALID (17)
20 #define GPIO_PCMCIA_S0_RDYINT (6)
21 #define GPIO_PCMCIA_S1_RDYINT (8)
22 #define GPIO_PCMCIA_RESET (9)
24 static int cmx255_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
26 int ret = gpio_request(GPIO_PCMCIA_RESET, "PCCard reset");
27 if (ret)
28 return ret;
29 gpio_direction_output(GPIO_PCMCIA_RESET, 0);
31 if (skt->nr == 0) {
32 skt->stat[SOC_STAT_CD].gpio = GPIO_PCMCIA_S0_CD_VALID;
33 skt->stat[SOC_STAT_CD].name = "PCMCIA0 CD";
34 skt->stat[SOC_STAT_RDY].gpio = GPIO_PCMCIA_S0_RDYINT;
35 skt->stat[SOC_STAT_RDY].name = "PCMCIA0 RDY";
36 } else {
37 skt->stat[SOC_STAT_CD].gpio = GPIO_PCMCIA_S1_CD_VALID;
38 skt->stat[SOC_STAT_CD].name = "PCMCIA1 CD";
39 skt->stat[SOC_STAT_RDY].gpio = GPIO_PCMCIA_S1_RDYINT;
40 skt->stat[SOC_STAT_RDY].name = "PCMCIA1 RDY";
43 return 0;
46 static void cmx255_pcmcia_shutdown(struct soc_pcmcia_socket *skt)
48 gpio_free(GPIO_PCMCIA_RESET);
52 static void cmx255_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
53 struct pcmcia_state *state)
55 state->vs_3v = 0;
56 state->vs_Xv = 0;
60 static int cmx255_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
61 const socket_state_t *state)
63 switch (skt->nr) {
64 case 0:
65 if (state->flags & SS_RESET) {
66 gpio_set_value(GPIO_PCMCIA_SKTSEL, 0);
67 udelay(1);
68 gpio_set_value(GPIO_PCMCIA_RESET, 1);
69 udelay(10);
70 gpio_set_value(GPIO_PCMCIA_RESET, 0);
72 break;
73 case 1:
74 if (state->flags & SS_RESET) {
75 gpio_set_value(GPIO_PCMCIA_SKTSEL, 1);
76 udelay(1);
77 gpio_set_value(GPIO_PCMCIA_RESET, 1);
78 udelay(10);
79 gpio_set_value(GPIO_PCMCIA_RESET, 0);
81 break;
84 return 0;
87 static struct pcmcia_low_level cmx255_pcmcia_ops __initdata = {
88 .owner = THIS_MODULE,
89 .hw_init = cmx255_pcmcia_hw_init,
90 .hw_shutdown = cmx255_pcmcia_shutdown,
91 .socket_state = cmx255_pcmcia_socket_state,
92 .configure_socket = cmx255_pcmcia_configure_socket,
93 .nr = 1,
96 static struct platform_device *cmx255_pcmcia_device;
98 int __init cmx255_pcmcia_init(void)
100 int ret;
102 cmx255_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
104 if (!cmx255_pcmcia_device)
105 return -ENOMEM;
107 ret = platform_device_add_data(cmx255_pcmcia_device, &cmx255_pcmcia_ops,
108 sizeof(cmx255_pcmcia_ops));
110 if (ret == 0) {
111 printk(KERN_INFO "Registering cm-x255 PCMCIA interface.\n");
112 ret = platform_device_add(cmx255_pcmcia_device);
115 if (ret)
116 platform_device_put(cmx255_pcmcia_device);
118 return ret;
121 void __exit cmx255_pcmcia_exit(void)
123 platform_device_unregister(cmx255_pcmcia_device);