1bf972790SLinus Walleij // SPDX-License-Identifier: GPL-2.0
2759f5f37SVivien Didelot /*
3759f5f37SVivien Didelot * Digital I/O driver for Technologic Systems TS-5500
4759f5f37SVivien Didelot *
5759f5f37SVivien Didelot * Copyright (c) 2012 Savoir-faire Linux Inc.
6759f5f37SVivien Didelot * Vivien Didelot <vivien.didelot@savoirfairelinux.com>
7759f5f37SVivien Didelot *
8759f5f37SVivien Didelot * Technologic Systems platforms have pin blocks, exposing several Digital
9759f5f37SVivien Didelot * Input/Output lines (DIO). This driver aims to support single pin blocks.
10759f5f37SVivien Didelot * In that sense, the support is not limited to the TS-5500 blocks.
11759f5f37SVivien Didelot * Actually, the following platforms have DIO support:
12759f5f37SVivien Didelot *
13759f5f37SVivien Didelot * TS-5500:
14*24f71ae5SKris Bahnsen * Documentation: https://docs.embeddedts.com/TS-5500
15759f5f37SVivien Didelot * Blocks: DIO1, DIO2 and LCD port.
16759f5f37SVivien Didelot *
17759f5f37SVivien Didelot * TS-5600:
18*24f71ae5SKris Bahnsen * Documentation: https://docs.embeddedts.com/TS-5600
19759f5f37SVivien Didelot * Blocks: LCD port (identical to TS-5500 LCD).
20759f5f37SVivien Didelot */
21759f5f37SVivien Didelot
22759f5f37SVivien Didelot #include <linux/bitops.h>
23c99601f6SLinus Walleij #include <linux/gpio/driver.h>
24759f5f37SVivien Didelot #include <linux/io.h>
25759f5f37SVivien Didelot #include <linux/module.h>
26759f5f37SVivien Didelot #include <linux/platform_device.h>
27759f5f37SVivien Didelot #include <linux/slab.h>
28759f5f37SVivien Didelot
29759f5f37SVivien Didelot /* List of supported Technologic Systems platforms DIO blocks */
30759f5f37SVivien Didelot enum ts5500_blocks { TS5500_DIO1, TS5500_DIO2, TS5500_LCD, TS5600_LCD };
31759f5f37SVivien Didelot
32759f5f37SVivien Didelot struct ts5500_priv {
33759f5f37SVivien Didelot const struct ts5500_dio *pinout;
34759f5f37SVivien Didelot struct gpio_chip gpio_chip;
35759f5f37SVivien Didelot spinlock_t lock;
36759f5f37SVivien Didelot bool strap;
37759f5f37SVivien Didelot u8 hwirq;
38759f5f37SVivien Didelot };
39759f5f37SVivien Didelot
40759f5f37SVivien Didelot /*
41759f5f37SVivien Didelot * Hex 7D is used to control several blocks (e.g. DIO2 and LCD port).
42759f5f37SVivien Didelot * This flag ensures that the region has been requested by this driver.
43759f5f37SVivien Didelot */
44759f5f37SVivien Didelot static bool hex7d_reserved;
45759f5f37SVivien Didelot
46759f5f37SVivien Didelot /*
47759f5f37SVivien Didelot * This structure is used to describe capabilities of DIO lines,
48759f5f37SVivien Didelot * such as available directions and connected interrupt (if any).
49759f5f37SVivien Didelot */
50759f5f37SVivien Didelot struct ts5500_dio {
51759f5f37SVivien Didelot const u8 value_addr;
52759f5f37SVivien Didelot const u8 value_mask;
53759f5f37SVivien Didelot const u8 control_addr;
54759f5f37SVivien Didelot const u8 control_mask;
55759f5f37SVivien Didelot const bool no_input;
56759f5f37SVivien Didelot const bool no_output;
57759f5f37SVivien Didelot const u8 irq;
58759f5f37SVivien Didelot };
59759f5f37SVivien Didelot
60759f5f37SVivien Didelot #define TS5500_DIO_IN_OUT(vaddr, vbit, caddr, cbit) \
61759f5f37SVivien Didelot { \
62759f5f37SVivien Didelot .value_addr = vaddr, \
63759f5f37SVivien Didelot .value_mask = BIT(vbit), \
64759f5f37SVivien Didelot .control_addr = caddr, \
65759f5f37SVivien Didelot .control_mask = BIT(cbit), \
66759f5f37SVivien Didelot }
67759f5f37SVivien Didelot
68759f5f37SVivien Didelot #define TS5500_DIO_IN(addr, bit) \
69759f5f37SVivien Didelot { \
70759f5f37SVivien Didelot .value_addr = addr, \
71759f5f37SVivien Didelot .value_mask = BIT(bit), \
72759f5f37SVivien Didelot .no_output = true, \
73759f5f37SVivien Didelot }
74759f5f37SVivien Didelot
75759f5f37SVivien Didelot #define TS5500_DIO_IN_IRQ(addr, bit, _irq) \
76759f5f37SVivien Didelot { \
77759f5f37SVivien Didelot .value_addr = addr, \
78759f5f37SVivien Didelot .value_mask = BIT(bit), \
79759f5f37SVivien Didelot .no_output = true, \
80759f5f37SVivien Didelot .irq = _irq, \
81759f5f37SVivien Didelot }
82759f5f37SVivien Didelot
83759f5f37SVivien Didelot #define TS5500_DIO_OUT(addr, bit) \
84759f5f37SVivien Didelot { \
85759f5f37SVivien Didelot .value_addr = addr, \
86759f5f37SVivien Didelot .value_mask = BIT(bit), \
87759f5f37SVivien Didelot .no_input = true, \
88759f5f37SVivien Didelot }
89759f5f37SVivien Didelot
90759f5f37SVivien Didelot /*
91759f5f37SVivien Didelot * Input/Output DIO lines are programmed in groups of 4. Their values are
92759f5f37SVivien Didelot * available through 4 consecutive bits in a value port, whereas the direction
93759f5f37SVivien Didelot * of these 4 lines is driven by only 1 bit in a control port.
94759f5f37SVivien Didelot */
95759f5f37SVivien Didelot #define TS5500_DIO_GROUP(vaddr, vbitfrom, caddr, cbit) \
96759f5f37SVivien Didelot TS5500_DIO_IN_OUT(vaddr, vbitfrom + 0, caddr, cbit), \
97759f5f37SVivien Didelot TS5500_DIO_IN_OUT(vaddr, vbitfrom + 1, caddr, cbit), \
98759f5f37SVivien Didelot TS5500_DIO_IN_OUT(vaddr, vbitfrom + 2, caddr, cbit), \
99759f5f37SVivien Didelot TS5500_DIO_IN_OUT(vaddr, vbitfrom + 3, caddr, cbit)
100759f5f37SVivien Didelot
101759f5f37SVivien Didelot /*
102759f5f37SVivien Didelot * TS-5500 DIO1 block
103759f5f37SVivien Didelot *
104759f5f37SVivien Didelot * value control dir hw
105759f5f37SVivien Didelot * addr bit addr bit in out irq name pin offset
106759f5f37SVivien Didelot *
107759f5f37SVivien Didelot * 0x7b 0 0x7a 0 x x DIO1_0 1 0
108759f5f37SVivien Didelot * 0x7b 1 0x7a 0 x x DIO1_1 3 1
109759f5f37SVivien Didelot * 0x7b 2 0x7a 0 x x DIO1_2 5 2
110759f5f37SVivien Didelot * 0x7b 3 0x7a 0 x x DIO1_3 7 3
111759f5f37SVivien Didelot * 0x7b 4 0x7a 1 x x DIO1_4 9 4
112759f5f37SVivien Didelot * 0x7b 5 0x7a 1 x x DIO1_5 11 5
113759f5f37SVivien Didelot * 0x7b 6 0x7a 1 x x DIO1_6 13 6
114759f5f37SVivien Didelot * 0x7b 7 0x7a 1 x x DIO1_7 15 7
115759f5f37SVivien Didelot * 0x7c 0 0x7a 5 x x DIO1_8 4 8
116759f5f37SVivien Didelot * 0x7c 1 0x7a 5 x x DIO1_9 6 9
117759f5f37SVivien Didelot * 0x7c 2 0x7a 5 x x DIO1_10 8 10
118759f5f37SVivien Didelot * 0x7c 3 0x7a 5 x x DIO1_11 10 11
119759f5f37SVivien Didelot * 0x7c 4 x DIO1_12 12 12
120759f5f37SVivien Didelot * 0x7c 5 x 7 DIO1_13 14 13
121759f5f37SVivien Didelot */
122759f5f37SVivien Didelot static const struct ts5500_dio ts5500_dio1[] = {
123759f5f37SVivien Didelot TS5500_DIO_GROUP(0x7b, 0, 0x7a, 0),
124759f5f37SVivien Didelot TS5500_DIO_GROUP(0x7b, 4, 0x7a, 1),
125759f5f37SVivien Didelot TS5500_DIO_GROUP(0x7c, 0, 0x7a, 5),
126759f5f37SVivien Didelot TS5500_DIO_IN(0x7c, 4),
127759f5f37SVivien Didelot TS5500_DIO_IN_IRQ(0x7c, 5, 7),
128759f5f37SVivien Didelot };
129759f5f37SVivien Didelot
130759f5f37SVivien Didelot /*
131759f5f37SVivien Didelot * TS-5500 DIO2 block
132759f5f37SVivien Didelot *
133759f5f37SVivien Didelot * value control dir hw
134759f5f37SVivien Didelot * addr bit addr bit in out irq name pin offset
135759f5f37SVivien Didelot *
136759f5f37SVivien Didelot * 0x7e 0 0x7d 0 x x DIO2_0 1 0
137759f5f37SVivien Didelot * 0x7e 1 0x7d 0 x x DIO2_1 3 1
138759f5f37SVivien Didelot * 0x7e 2 0x7d 0 x x DIO2_2 5 2
139759f5f37SVivien Didelot * 0x7e 3 0x7d 0 x x DIO2_3 7 3
140759f5f37SVivien Didelot * 0x7e 4 0x7d 1 x x DIO2_4 9 4
141759f5f37SVivien Didelot * 0x7e 5 0x7d 1 x x DIO2_5 11 5
142759f5f37SVivien Didelot * 0x7e 6 0x7d 1 x x DIO2_6 13 6
143759f5f37SVivien Didelot * 0x7e 7 0x7d 1 x x DIO2_7 15 7
144759f5f37SVivien Didelot * 0x7f 0 0x7d 5 x x DIO2_8 4 8
145759f5f37SVivien Didelot * 0x7f 1 0x7d 5 x x DIO2_9 6 9
146759f5f37SVivien Didelot * 0x7f 2 0x7d 5 x x DIO2_10 8 10
147759f5f37SVivien Didelot * 0x7f 3 0x7d 5 x x DIO2_11 10 11
148759f5f37SVivien Didelot * 0x7f 4 x 6 DIO2_13 14 12
149759f5f37SVivien Didelot */
150759f5f37SVivien Didelot static const struct ts5500_dio ts5500_dio2[] = {
151759f5f37SVivien Didelot TS5500_DIO_GROUP(0x7e, 0, 0x7d, 0),
152759f5f37SVivien Didelot TS5500_DIO_GROUP(0x7e, 4, 0x7d, 1),
153759f5f37SVivien Didelot TS5500_DIO_GROUP(0x7f, 0, 0x7d, 5),
154759f5f37SVivien Didelot TS5500_DIO_IN_IRQ(0x7f, 4, 6),
155759f5f37SVivien Didelot };
156759f5f37SVivien Didelot
157759f5f37SVivien Didelot /*
158759f5f37SVivien Didelot * TS-5500 LCD port used as DIO block
159759f5f37SVivien Didelot * TS-5600 LCD port is identical
160759f5f37SVivien Didelot *
161759f5f37SVivien Didelot * value control dir hw
162759f5f37SVivien Didelot * addr bit addr bit in out irq name pin offset
163759f5f37SVivien Didelot *
164759f5f37SVivien Didelot * 0x72 0 0x7d 2 x x LCD_0 8 0
165759f5f37SVivien Didelot * 0x72 1 0x7d 2 x x LCD_1 7 1
166759f5f37SVivien Didelot * 0x72 2 0x7d 2 x x LCD_2 10 2
167759f5f37SVivien Didelot * 0x72 3 0x7d 2 x x LCD_3 9 3
168759f5f37SVivien Didelot * 0x72 4 0x7d 3 x x LCD_4 12 4
169759f5f37SVivien Didelot * 0x72 5 0x7d 3 x x LCD_5 11 5
170759f5f37SVivien Didelot * 0x72 6 0x7d 3 x x LCD_6 14 6
171759f5f37SVivien Didelot * 0x72 7 0x7d 3 x x LCD_7 13 7
172759f5f37SVivien Didelot * 0x73 0 x LCD_EN 5 8
173759f5f37SVivien Didelot * 0x73 6 x LCD_WR 6 9
174759f5f37SVivien Didelot * 0x73 7 x 1 LCD_RS 3 10
175759f5f37SVivien Didelot */
176759f5f37SVivien Didelot static const struct ts5500_dio ts5500_lcd[] = {
177759f5f37SVivien Didelot TS5500_DIO_GROUP(0x72, 0, 0x7d, 2),
178759f5f37SVivien Didelot TS5500_DIO_GROUP(0x72, 4, 0x7d, 3),
179759f5f37SVivien Didelot TS5500_DIO_OUT(0x73, 0),
180759f5f37SVivien Didelot TS5500_DIO_IN(0x73, 6),
181759f5f37SVivien Didelot TS5500_DIO_IN_IRQ(0x73, 7, 1),
182759f5f37SVivien Didelot };
183759f5f37SVivien Didelot
ts5500_set_mask(u8 mask,u8 addr)184759f5f37SVivien Didelot static inline void ts5500_set_mask(u8 mask, u8 addr)
185759f5f37SVivien Didelot {
186759f5f37SVivien Didelot u8 val = inb(addr);
187759f5f37SVivien Didelot val |= mask;
188759f5f37SVivien Didelot outb(val, addr);
189759f5f37SVivien Didelot }
190759f5f37SVivien Didelot
ts5500_clear_mask(u8 mask,u8 addr)191759f5f37SVivien Didelot static inline void ts5500_clear_mask(u8 mask, u8 addr)
192759f5f37SVivien Didelot {
193759f5f37SVivien Didelot u8 val = inb(addr);
194759f5f37SVivien Didelot val &= ~mask;
195759f5f37SVivien Didelot outb(val, addr);
196759f5f37SVivien Didelot }
197759f5f37SVivien Didelot
ts5500_gpio_input(struct gpio_chip * chip,unsigned offset)198759f5f37SVivien Didelot static int ts5500_gpio_input(struct gpio_chip *chip, unsigned offset)
199759f5f37SVivien Didelot {
20011ab89acSLinus Walleij struct ts5500_priv *priv = gpiochip_get_data(chip);
201759f5f37SVivien Didelot const struct ts5500_dio line = priv->pinout[offset];
202759f5f37SVivien Didelot unsigned long flags;
203759f5f37SVivien Didelot
204759f5f37SVivien Didelot if (line.no_input)
205759f5f37SVivien Didelot return -ENXIO;
206759f5f37SVivien Didelot
207759f5f37SVivien Didelot if (line.no_output)
208759f5f37SVivien Didelot return 0;
209759f5f37SVivien Didelot
210759f5f37SVivien Didelot spin_lock_irqsave(&priv->lock, flags);
211759f5f37SVivien Didelot ts5500_clear_mask(line.control_mask, line.control_addr);
212759f5f37SVivien Didelot spin_unlock_irqrestore(&priv->lock, flags);
213759f5f37SVivien Didelot
214759f5f37SVivien Didelot return 0;
215759f5f37SVivien Didelot }
216759f5f37SVivien Didelot
ts5500_gpio_get(struct gpio_chip * chip,unsigned offset)217759f5f37SVivien Didelot static int ts5500_gpio_get(struct gpio_chip *chip, unsigned offset)
218759f5f37SVivien Didelot {
21911ab89acSLinus Walleij struct ts5500_priv *priv = gpiochip_get_data(chip);
220759f5f37SVivien Didelot const struct ts5500_dio line = priv->pinout[offset];
221759f5f37SVivien Didelot
222759f5f37SVivien Didelot return !!(inb(line.value_addr) & line.value_mask);
223759f5f37SVivien Didelot }
224759f5f37SVivien Didelot
ts5500_gpio_output(struct gpio_chip * chip,unsigned offset,int val)225759f5f37SVivien Didelot static int ts5500_gpio_output(struct gpio_chip *chip, unsigned offset, int val)
226759f5f37SVivien Didelot {
22711ab89acSLinus Walleij struct ts5500_priv *priv = gpiochip_get_data(chip);
228759f5f37SVivien Didelot const struct ts5500_dio line = priv->pinout[offset];
229759f5f37SVivien Didelot unsigned long flags;
230759f5f37SVivien Didelot
231759f5f37SVivien Didelot if (line.no_output)
232759f5f37SVivien Didelot return -ENXIO;
233759f5f37SVivien Didelot
234759f5f37SVivien Didelot spin_lock_irqsave(&priv->lock, flags);
235759f5f37SVivien Didelot if (!line.no_input)
236759f5f37SVivien Didelot ts5500_set_mask(line.control_mask, line.control_addr);
237759f5f37SVivien Didelot
238759f5f37SVivien Didelot if (val)
239759f5f37SVivien Didelot ts5500_set_mask(line.value_mask, line.value_addr);
240759f5f37SVivien Didelot else
241759f5f37SVivien Didelot ts5500_clear_mask(line.value_mask, line.value_addr);
242759f5f37SVivien Didelot spin_unlock_irqrestore(&priv->lock, flags);
243759f5f37SVivien Didelot
244759f5f37SVivien Didelot return 0;
245759f5f37SVivien Didelot }
246759f5f37SVivien Didelot
ts5500_gpio_set(struct gpio_chip * chip,unsigned offset,int val)247759f5f37SVivien Didelot static void ts5500_gpio_set(struct gpio_chip *chip, unsigned offset, int val)
248759f5f37SVivien Didelot {
24911ab89acSLinus Walleij struct ts5500_priv *priv = gpiochip_get_data(chip);
250759f5f37SVivien Didelot const struct ts5500_dio line = priv->pinout[offset];
251759f5f37SVivien Didelot unsigned long flags;
252759f5f37SVivien Didelot
253759f5f37SVivien Didelot spin_lock_irqsave(&priv->lock, flags);
254759f5f37SVivien Didelot if (val)
255759f5f37SVivien Didelot ts5500_set_mask(line.value_mask, line.value_addr);
256759f5f37SVivien Didelot else
257759f5f37SVivien Didelot ts5500_clear_mask(line.value_mask, line.value_addr);
258759f5f37SVivien Didelot spin_unlock_irqrestore(&priv->lock, flags);
259759f5f37SVivien Didelot }
260759f5f37SVivien Didelot
ts5500_gpio_to_irq(struct gpio_chip * chip,unsigned offset)261759f5f37SVivien Didelot static int ts5500_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
262759f5f37SVivien Didelot {
26311ab89acSLinus Walleij struct ts5500_priv *priv = gpiochip_get_data(chip);
264759f5f37SVivien Didelot const struct ts5500_dio *block = priv->pinout;
265759f5f37SVivien Didelot const struct ts5500_dio line = block[offset];
266759f5f37SVivien Didelot
267759f5f37SVivien Didelot /* Only one pin is connected to an interrupt */
268759f5f37SVivien Didelot if (line.irq)
269759f5f37SVivien Didelot return line.irq;
270759f5f37SVivien Didelot
271759f5f37SVivien Didelot /* As this pin is input-only, we may strap it to another in/out pin */
272759f5f37SVivien Didelot if (priv->strap)
273759f5f37SVivien Didelot return priv->hwirq;
274759f5f37SVivien Didelot
275759f5f37SVivien Didelot return -ENXIO;
276759f5f37SVivien Didelot }
277759f5f37SVivien Didelot
ts5500_enable_irq(struct ts5500_priv * priv)278759f5f37SVivien Didelot static int ts5500_enable_irq(struct ts5500_priv *priv)
279759f5f37SVivien Didelot {
280759f5f37SVivien Didelot int ret = 0;
281759f5f37SVivien Didelot unsigned long flags;
282759f5f37SVivien Didelot
283759f5f37SVivien Didelot spin_lock_irqsave(&priv->lock, flags);
284759f5f37SVivien Didelot if (priv->hwirq == 7)
285759f5f37SVivien Didelot ts5500_set_mask(BIT(7), 0x7a); /* DIO1_13 on IRQ7 */
286759f5f37SVivien Didelot else if (priv->hwirq == 6)
287759f5f37SVivien Didelot ts5500_set_mask(BIT(7), 0x7d); /* DIO2_13 on IRQ6 */
288759f5f37SVivien Didelot else if (priv->hwirq == 1)
289759f5f37SVivien Didelot ts5500_set_mask(BIT(6), 0x7d); /* LCD_RS on IRQ1 */
290759f5f37SVivien Didelot else
291759f5f37SVivien Didelot ret = -EINVAL;
292759f5f37SVivien Didelot spin_unlock_irqrestore(&priv->lock, flags);
293759f5f37SVivien Didelot
294759f5f37SVivien Didelot return ret;
295759f5f37SVivien Didelot }
296759f5f37SVivien Didelot
ts5500_disable_irq(struct ts5500_priv * priv)297759f5f37SVivien Didelot static void ts5500_disable_irq(struct ts5500_priv *priv)
298759f5f37SVivien Didelot {
299759f5f37SVivien Didelot unsigned long flags;
300759f5f37SVivien Didelot
301759f5f37SVivien Didelot spin_lock_irqsave(&priv->lock, flags);
302759f5f37SVivien Didelot if (priv->hwirq == 7)
303759f5f37SVivien Didelot ts5500_clear_mask(BIT(7), 0x7a); /* DIO1_13 on IRQ7 */
304759f5f37SVivien Didelot else if (priv->hwirq == 6)
305759f5f37SVivien Didelot ts5500_clear_mask(BIT(7), 0x7d); /* DIO2_13 on IRQ6 */
306759f5f37SVivien Didelot else if (priv->hwirq == 1)
307759f5f37SVivien Didelot ts5500_clear_mask(BIT(6), 0x7d); /* LCD_RS on IRQ1 */
308759f5f37SVivien Didelot else
30958383c78SLinus Walleij dev_err(priv->gpio_chip.parent, "invalid hwirq %d\n",
31058383c78SLinus Walleij priv->hwirq);
311759f5f37SVivien Didelot spin_unlock_irqrestore(&priv->lock, flags);
312759f5f37SVivien Didelot }
313759f5f37SVivien Didelot
ts5500_dio_probe(struct platform_device * pdev)3140fe763c5SGreg Kroah-Hartman static int ts5500_dio_probe(struct platform_device *pdev)
315759f5f37SVivien Didelot {
316759f5f37SVivien Didelot enum ts5500_blocks block = platform_get_device_id(pdev)->driver_data;
317759f5f37SVivien Didelot struct device *dev = &pdev->dev;
318759f5f37SVivien Didelot const char *name = dev_name(dev);
319759f5f37SVivien Didelot struct ts5500_priv *priv;
320759f5f37SVivien Didelot unsigned long flags;
321759f5f37SVivien Didelot int ret;
322759f5f37SVivien Didelot
3236408693fSLad Prabhakar ret = platform_get_irq(pdev, 0);
3246408693fSLad Prabhakar if (ret < 0)
3256408693fSLad Prabhakar return ret;
326759f5f37SVivien Didelot
327759f5f37SVivien Didelot priv = devm_kzalloc(dev, sizeof(struct ts5500_priv), GFP_KERNEL);
328759f5f37SVivien Didelot if (!priv)
329759f5f37SVivien Didelot return -ENOMEM;
330759f5f37SVivien Didelot
331759f5f37SVivien Didelot platform_set_drvdata(pdev, priv);
3326408693fSLad Prabhakar priv->hwirq = ret;
333759f5f37SVivien Didelot spin_lock_init(&priv->lock);
334759f5f37SVivien Didelot
335759f5f37SVivien Didelot priv->gpio_chip.owner = THIS_MODULE;
336759f5f37SVivien Didelot priv->gpio_chip.label = name;
33758383c78SLinus Walleij priv->gpio_chip.parent = dev;
338759f5f37SVivien Didelot priv->gpio_chip.direction_input = ts5500_gpio_input;
339759f5f37SVivien Didelot priv->gpio_chip.direction_output = ts5500_gpio_output;
340759f5f37SVivien Didelot priv->gpio_chip.get = ts5500_gpio_get;
341759f5f37SVivien Didelot priv->gpio_chip.set = ts5500_gpio_set;
342759f5f37SVivien Didelot priv->gpio_chip.to_irq = ts5500_gpio_to_irq;
343759f5f37SVivien Didelot priv->gpio_chip.base = -1;
344759f5f37SVivien Didelot
345759f5f37SVivien Didelot switch (block) {
346759f5f37SVivien Didelot case TS5500_DIO1:
347759f5f37SVivien Didelot priv->pinout = ts5500_dio1;
348759f5f37SVivien Didelot priv->gpio_chip.ngpio = ARRAY_SIZE(ts5500_dio1);
349759f5f37SVivien Didelot
350759f5f37SVivien Didelot if (!devm_request_region(dev, 0x7a, 3, name)) {
351759f5f37SVivien Didelot dev_err(dev, "failed to request %s ports\n", name);
352759f5f37SVivien Didelot return -EBUSY;
353759f5f37SVivien Didelot }
354759f5f37SVivien Didelot break;
355759f5f37SVivien Didelot case TS5500_DIO2:
356759f5f37SVivien Didelot priv->pinout = ts5500_dio2;
357759f5f37SVivien Didelot priv->gpio_chip.ngpio = ARRAY_SIZE(ts5500_dio2);
358759f5f37SVivien Didelot
359759f5f37SVivien Didelot if (!devm_request_region(dev, 0x7e, 2, name)) {
360759f5f37SVivien Didelot dev_err(dev, "failed to request %s ports\n", name);
361759f5f37SVivien Didelot return -EBUSY;
362759f5f37SVivien Didelot }
363759f5f37SVivien Didelot
364759f5f37SVivien Didelot if (hex7d_reserved)
365759f5f37SVivien Didelot break;
366759f5f37SVivien Didelot
367759f5f37SVivien Didelot if (!devm_request_region(dev, 0x7d, 1, name)) {
368759f5f37SVivien Didelot dev_err(dev, "failed to request %s 7D\n", name);
369759f5f37SVivien Didelot return -EBUSY;
370759f5f37SVivien Didelot }
371759f5f37SVivien Didelot
372759f5f37SVivien Didelot hex7d_reserved = true;
373759f5f37SVivien Didelot break;
374759f5f37SVivien Didelot case TS5500_LCD:
375759f5f37SVivien Didelot case TS5600_LCD:
376759f5f37SVivien Didelot priv->pinout = ts5500_lcd;
377759f5f37SVivien Didelot priv->gpio_chip.ngpio = ARRAY_SIZE(ts5500_lcd);
378759f5f37SVivien Didelot
379759f5f37SVivien Didelot if (!devm_request_region(dev, 0x72, 2, name)) {
380759f5f37SVivien Didelot dev_err(dev, "failed to request %s ports\n", name);
381759f5f37SVivien Didelot return -EBUSY;
382759f5f37SVivien Didelot }
383759f5f37SVivien Didelot
384759f5f37SVivien Didelot if (!hex7d_reserved) {
385759f5f37SVivien Didelot if (!devm_request_region(dev, 0x7d, 1, name)) {
386759f5f37SVivien Didelot dev_err(dev, "failed to request %s 7D\n", name);
387759f5f37SVivien Didelot return -EBUSY;
388759f5f37SVivien Didelot }
389759f5f37SVivien Didelot
390759f5f37SVivien Didelot hex7d_reserved = true;
391759f5f37SVivien Didelot }
392759f5f37SVivien Didelot
393759f5f37SVivien Didelot /* Ensure usage of LCD port as DIO */
394759f5f37SVivien Didelot spin_lock_irqsave(&priv->lock, flags);
395759f5f37SVivien Didelot ts5500_clear_mask(BIT(4), 0x7d);
396759f5f37SVivien Didelot spin_unlock_irqrestore(&priv->lock, flags);
397759f5f37SVivien Didelot break;
398759f5f37SVivien Didelot }
399759f5f37SVivien Didelot
400973eff01SLaxman Dewangan ret = devm_gpiochip_add_data(dev, &priv->gpio_chip, priv);
401759f5f37SVivien Didelot if (ret) {
402759f5f37SVivien Didelot dev_err(dev, "failed to register the gpio chip\n");
403759f5f37SVivien Didelot return ret;
404759f5f37SVivien Didelot }
405759f5f37SVivien Didelot
406759f5f37SVivien Didelot ret = ts5500_enable_irq(priv);
407759f5f37SVivien Didelot if (ret) {
408759f5f37SVivien Didelot dev_err(dev, "invalid interrupt %d\n", priv->hwirq);
409973eff01SLaxman Dewangan return ret;
410759f5f37SVivien Didelot }
411759f5f37SVivien Didelot
412759f5f37SVivien Didelot return 0;
413759f5f37SVivien Didelot }
414759f5f37SVivien Didelot
ts5500_dio_remove(struct platform_device * pdev)4150fe763c5SGreg Kroah-Hartman static int ts5500_dio_remove(struct platform_device *pdev)
416759f5f37SVivien Didelot {
417759f5f37SVivien Didelot struct ts5500_priv *priv = platform_get_drvdata(pdev);
418759f5f37SVivien Didelot
419759f5f37SVivien Didelot ts5500_disable_irq(priv);
420973eff01SLaxman Dewangan
4219f5132aeSabdoulaye berthe return 0;
422759f5f37SVivien Didelot }
423759f5f37SVivien Didelot
424f4f79d40SKrzysztof Kozlowski static const struct platform_device_id ts5500_dio_ids[] = {
425759f5f37SVivien Didelot { "ts5500-dio1", TS5500_DIO1 },
426759f5f37SVivien Didelot { "ts5500-dio2", TS5500_DIO2 },
427759f5f37SVivien Didelot { "ts5500-dio-lcd", TS5500_LCD },
428759f5f37SVivien Didelot { "ts5600-dio-lcd", TS5600_LCD },
429759f5f37SVivien Didelot { }
430759f5f37SVivien Didelot };
431759f5f37SVivien Didelot MODULE_DEVICE_TABLE(platform, ts5500_dio_ids);
432759f5f37SVivien Didelot
433759f5f37SVivien Didelot static struct platform_driver ts5500_dio_driver = {
434759f5f37SVivien Didelot .driver = {
435759f5f37SVivien Didelot .name = "ts5500-dio",
436759f5f37SVivien Didelot },
437759f5f37SVivien Didelot .probe = ts5500_dio_probe,
4380fe763c5SGreg Kroah-Hartman .remove = ts5500_dio_remove,
439759f5f37SVivien Didelot .id_table = ts5500_dio_ids,
440759f5f37SVivien Didelot };
441759f5f37SVivien Didelot
442759f5f37SVivien Didelot module_platform_driver(ts5500_dio_driver);
443759f5f37SVivien Didelot
444759f5f37SVivien Didelot MODULE_LICENSE("GPL");
445759f5f37SVivien Didelot MODULE_AUTHOR("Savoir-faire Linux Inc. <kernel@savoirfairelinux.com>");
446759f5f37SVivien Didelot MODULE_DESCRIPTION("Technologic Systems TS-5500 Digital I/O driver");
447