1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * drivers/pcmcia/sa1100_jornada720.c
4 *
5 * Jornada720 PCMCIA specific routines
6 *
7 */
8 #include <linux/module.h>
9 #include <linux/device.h>
10 #include <linux/errno.h>
11 #include <linux/gpio/consumer.h>
12 #include <linux/init.h>
13 #include <linux/io.h>
14
15 #include <mach/hardware.h>
16 #include <asm/mach-types.h>
17
18 #include "sa1111_generic.h"
19
20 /*
21 * Socket 0 power: GPIO A0
22 * Socket 0 3V: GPIO A2
23 * Socket 1 power: GPIO A1 & GPIO A3
24 * Socket 1 3V: GPIO A3
25 * Does Socket 1 3V actually do anything?
26 */
27 enum {
28 J720_GPIO_PWR,
29 J720_GPIO_3V,
30 J720_GPIO_MAX,
31 };
32 struct jornada720_data {
33 struct gpio_desc *gpio[J720_GPIO_MAX];
34 };
35
jornada720_pcmcia_hw_init(struct soc_pcmcia_socket * skt)36 static int jornada720_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
37 {
38 struct device *dev = skt->socket.dev.parent;
39 struct jornada720_data *j;
40
41 j = devm_kzalloc(dev, sizeof(*j), GFP_KERNEL);
42 if (!j)
43 return -ENOMEM;
44
45 j->gpio[J720_GPIO_PWR] = devm_gpiod_get(dev, skt->nr ? "s1-power" :
46 "s0-power", GPIOD_OUT_LOW);
47 if (IS_ERR(j->gpio[J720_GPIO_PWR]))
48 return PTR_ERR(j->gpio[J720_GPIO_PWR]);
49
50 j->gpio[J720_GPIO_3V] = devm_gpiod_get(dev, skt->nr ? "s1-3v" :
51 "s0-3v", GPIOD_OUT_LOW);
52 if (IS_ERR(j->gpio[J720_GPIO_3V]))
53 return PTR_ERR(j->gpio[J720_GPIO_3V]);
54
55 skt->driver_data = j;
56
57 return 0;
58 }
59
60 static int
jornada720_pcmcia_configure_socket(struct soc_pcmcia_socket * skt,const socket_state_t * state)61 jornada720_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state)
62 {
63 struct jornada720_data *j = skt->driver_data;
64 DECLARE_BITMAP(values, J720_GPIO_MAX) = { 0, };
65 int ret;
66
67 printk(KERN_INFO "%s(): config socket %d vcc %d vpp %d\n", __func__,
68 skt->nr, state->Vcc, state->Vpp);
69
70 switch (skt->nr) {
71 case 0:
72 switch (state->Vcc) {
73 default:
74 case 0:
75 __assign_bit(J720_GPIO_PWR, values, 0);
76 __assign_bit(J720_GPIO_3V, values, 0);
77 break;
78 case 33:
79 __assign_bit(J720_GPIO_PWR, values, 1);
80 __assign_bit(J720_GPIO_3V, values, 1);
81 break;
82 case 50:
83 __assign_bit(J720_GPIO_PWR, values, 1);
84 __assign_bit(J720_GPIO_3V, values, 0);
85 break;
86 }
87 break;
88
89 case 1:
90 switch (state->Vcc) {
91 default:
92 case 0:
93 __assign_bit(J720_GPIO_PWR, values, 0);
94 __assign_bit(J720_GPIO_3V, values, 0);
95 break;
96 case 33:
97 case 50:
98 __assign_bit(J720_GPIO_PWR, values, 1);
99 __assign_bit(J720_GPIO_3V, values, 1);
100 break;
101 }
102 break;
103
104 default:
105 return -1;
106 }
107
108 if (state->Vpp != state->Vcc && state->Vpp != 0) {
109 printk(KERN_ERR "%s(): slot cannot support VPP %u\n",
110 __func__, state->Vpp);
111 return -EPERM;
112 }
113
114 ret = sa1111_pcmcia_configure_socket(skt, state);
115 if (ret == 0)
116 ret = gpiod_set_array_value_cansleep(J720_GPIO_MAX, j->gpio,
117 NULL, values);
118
119 return ret;
120 }
121
122 static struct pcmcia_low_level jornada720_pcmcia_ops = {
123 .owner = THIS_MODULE,
124 .hw_init = jornada720_pcmcia_hw_init,
125 .configure_socket = jornada720_pcmcia_configure_socket,
126 .first = 0,
127 .nr = 2,
128 };
129
pcmcia_jornada720_init(struct sa1111_dev * sadev)130 int pcmcia_jornada720_init(struct sa1111_dev *sadev)
131 {
132 /* Fixme: why messing around with SA11x0's GPIO1? */
133 GRER |= 0x00000002;
134
135 sa11xx_drv_pcmcia_ops(&jornada720_pcmcia_ops);
136 return sa1111_pcmcia_add(sadev, &jornada720_pcmcia_ops,
137 sa11xx_drv_pcmcia_add_one);
138 }
139