1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Intel Crystal Cove GPIO Driver
4  *
5  * Copyright (C) 2012, 2014 Intel Corporation. All rights reserved.
6  *
7  * Author: Yang, Bin <bin.yang@intel.com>
8  */
9 
10 #include <linux/bitops.h>
11 #include <linux/gpio/driver.h>
12 #include <linux/interrupt.h>
13 #include <linux/mfd/intel_soc_pmic.h>
14 #include <linux/module.h>
15 #include <linux/platform_device.h>
16 #include <linux/regmap.h>
17 #include <linux/seq_file.h>
18 
19 #define CRYSTALCOVE_GPIO_NUM	16
20 #define CRYSTALCOVE_VGPIO_NUM	95
21 
22 #define UPDATE_IRQ_TYPE		BIT(0)
23 #define UPDATE_IRQ_MASK		BIT(1)
24 
25 #define GPIO0IRQ		0x0b
26 #define GPIO1IRQ		0x0c
27 #define MGPIO0IRQS0		0x19
28 #define MGPIO1IRQS0		0x1a
29 #define MGPIO0IRQSX		0x1b
30 #define MGPIO1IRQSX		0x1c
31 #define GPIO0P0CTLO		0x2b
32 #define GPIO0P0CTLI		0x33
33 #define GPIO1P0CTLO		0x3b
34 #define GPIO1P0CTLI		0x43
35 #define GPIOPANELCTL		0x52
36 
37 #define CTLI_INTCNT_DIS		(0)
38 #define CTLI_INTCNT_NE		(1 << 1)
39 #define CTLI_INTCNT_PE		(2 << 1)
40 #define CTLI_INTCNT_BE		(3 << 1)
41 
42 #define CTLO_DIR_IN		(0)
43 #define CTLO_DIR_OUT		(1 << 5)
44 
45 #define CTLO_DRV_CMOS		(0)
46 #define CTLO_DRV_OD		(1 << 4)
47 
48 #define CTLO_DRV_REN		(1 << 3)
49 
50 #define CTLO_RVAL_2KDW		(0)
51 #define CTLO_RVAL_2KUP		(1 << 1)
52 #define CTLO_RVAL_50KDW		(2 << 1)
53 #define CTLO_RVAL_50KUP		(3 << 1)
54 
55 #define CTLO_INPUT_SET	(CTLO_DRV_CMOS | CTLO_DRV_REN | CTLO_RVAL_2KUP)
56 #define CTLO_OUTPUT_SET	(CTLO_DIR_OUT | CTLO_INPUT_SET)
57 
58 enum ctrl_register {
59 	CTRL_IN,
60 	CTRL_OUT,
61 };
62 
63 /**
64  * struct crystalcove_gpio - Crystal Cove GPIO controller
65  * @buslock: for bus lock/sync and unlock.
66  * @chip: the abstract gpio_chip structure.
67  * @regmap: the regmap from the parent device.
68  * @update: pending IRQ setting update, to be written to the chip upon unlock.
69  * @intcnt_value: the Interrupt Detect value to be written.
70  * @set_irq_mask: true if the IRQ mask needs to be set, false to clear.
71  */
72 struct crystalcove_gpio {
73 	struct mutex buslock; /* irq_bus_lock */
74 	struct gpio_chip chip;
75 	struct regmap *regmap;
76 	int update;
77 	int intcnt_value;
78 	bool set_irq_mask;
79 };
80 
81 static inline int to_reg(int gpio, enum ctrl_register reg_type)
82 {
83 	int reg;
84 
85 	if (gpio >= CRYSTALCOVE_GPIO_NUM) {
86 		/*
87 		 * Virtual GPIO called from ACPI, for now we only support
88 		 * the panel ctl.
89 		 */
90 		switch (gpio) {
91 		case 0x5e:
92 			return GPIOPANELCTL;
93 		default:
94 			return -EOPNOTSUPP;
95 		}
96 	}
97 
98 	if (reg_type == CTRL_IN) {
99 		if (gpio < 8)
100 			reg = GPIO0P0CTLI;
101 		else
102 			reg = GPIO1P0CTLI;
103 	} else {
104 		if (gpio < 8)
105 			reg = GPIO0P0CTLO;
106 		else
107 			reg = GPIO1P0CTLO;
108 	}
109 
110 	return reg + gpio % 8;
111 }
112 
113 static void crystalcove_update_irq_mask(struct crystalcove_gpio *cg,
114 					int gpio)
115 {
116 	u8 mirqs0 = gpio < 8 ? MGPIO0IRQS0 : MGPIO1IRQS0;
117 	int mask = BIT(gpio % 8);
118 
119 	if (cg->set_irq_mask)
120 		regmap_update_bits(cg->regmap, mirqs0, mask, mask);
121 	else
122 		regmap_update_bits(cg->regmap, mirqs0, mask, 0);
123 }
124 
125 static void crystalcove_update_irq_ctrl(struct crystalcove_gpio *cg, int gpio)
126 {
127 	int reg = to_reg(gpio, CTRL_IN);
128 
129 	regmap_update_bits(cg->regmap, reg, CTLI_INTCNT_BE, cg->intcnt_value);
130 }
131 
132 static int crystalcove_gpio_dir_in(struct gpio_chip *chip, unsigned gpio)
133 {
134 	struct crystalcove_gpio *cg = gpiochip_get_data(chip);
135 	int reg = to_reg(gpio, CTRL_OUT);
136 
137 	if (reg < 0)
138 		return 0;
139 
140 	return regmap_write(cg->regmap, reg, CTLO_INPUT_SET);
141 }
142 
143 static int crystalcove_gpio_dir_out(struct gpio_chip *chip, unsigned gpio,
144 				    int value)
145 {
146 	struct crystalcove_gpio *cg = gpiochip_get_data(chip);
147 	int reg = to_reg(gpio, CTRL_OUT);
148 
149 	if (reg < 0)
150 		return 0;
151 
152 	return regmap_write(cg->regmap, reg, CTLO_OUTPUT_SET | value);
153 }
154 
155 static int crystalcove_gpio_get(struct gpio_chip *chip, unsigned gpio)
156 {
157 	struct crystalcove_gpio *cg = gpiochip_get_data(chip);
158 	unsigned int val;
159 	int ret, reg = to_reg(gpio, CTRL_IN);
160 
161 	if (reg < 0)
162 		return 0;
163 
164 	ret = regmap_read(cg->regmap, reg, &val);
165 	if (ret)
166 		return ret;
167 
168 	return val & 0x1;
169 }
170 
171 static void crystalcove_gpio_set(struct gpio_chip *chip,
172 				 unsigned gpio, int value)
173 {
174 	struct crystalcove_gpio *cg = gpiochip_get_data(chip);
175 	int reg = to_reg(gpio, CTRL_OUT);
176 
177 	if (reg < 0)
178 		return;
179 
180 	if (value)
181 		regmap_update_bits(cg->regmap, reg, 1, 1);
182 	else
183 		regmap_update_bits(cg->regmap, reg, 1, 0);
184 }
185 
186 static int crystalcove_irq_type(struct irq_data *data, unsigned type)
187 {
188 	struct crystalcove_gpio *cg =
189 		gpiochip_get_data(irq_data_get_irq_chip_data(data));
190 
191 	if (data->hwirq >= CRYSTALCOVE_GPIO_NUM)
192 		return 0;
193 
194 	switch (type) {
195 	case IRQ_TYPE_NONE:
196 		cg->intcnt_value = CTLI_INTCNT_DIS;
197 		break;
198 	case IRQ_TYPE_EDGE_BOTH:
199 		cg->intcnt_value = CTLI_INTCNT_BE;
200 		break;
201 	case IRQ_TYPE_EDGE_RISING:
202 		cg->intcnt_value = CTLI_INTCNT_PE;
203 		break;
204 	case IRQ_TYPE_EDGE_FALLING:
205 		cg->intcnt_value = CTLI_INTCNT_NE;
206 		break;
207 	default:
208 		return -EINVAL;
209 	}
210 
211 	cg->update |= UPDATE_IRQ_TYPE;
212 
213 	return 0;
214 }
215 
216 static void crystalcove_bus_lock(struct irq_data *data)
217 {
218 	struct crystalcove_gpio *cg =
219 		gpiochip_get_data(irq_data_get_irq_chip_data(data));
220 
221 	mutex_lock(&cg->buslock);
222 }
223 
224 static void crystalcove_bus_sync_unlock(struct irq_data *data)
225 {
226 	struct crystalcove_gpio *cg =
227 		gpiochip_get_data(irq_data_get_irq_chip_data(data));
228 	int gpio = data->hwirq;
229 
230 	if (cg->update & UPDATE_IRQ_TYPE)
231 		crystalcove_update_irq_ctrl(cg, gpio);
232 	if (cg->update & UPDATE_IRQ_MASK)
233 		crystalcove_update_irq_mask(cg, gpio);
234 	cg->update = 0;
235 
236 	mutex_unlock(&cg->buslock);
237 }
238 
239 static void crystalcove_irq_unmask(struct irq_data *data)
240 {
241 	struct crystalcove_gpio *cg =
242 		gpiochip_get_data(irq_data_get_irq_chip_data(data));
243 
244 	if (data->hwirq < CRYSTALCOVE_GPIO_NUM) {
245 		cg->set_irq_mask = false;
246 		cg->update |= UPDATE_IRQ_MASK;
247 	}
248 }
249 
250 static void crystalcove_irq_mask(struct irq_data *data)
251 {
252 	struct crystalcove_gpio *cg =
253 		gpiochip_get_data(irq_data_get_irq_chip_data(data));
254 
255 	if (data->hwirq < CRYSTALCOVE_GPIO_NUM) {
256 		cg->set_irq_mask = true;
257 		cg->update |= UPDATE_IRQ_MASK;
258 	}
259 }
260 
261 static struct irq_chip crystalcove_irqchip = {
262 	.name			= "Crystal Cove",
263 	.irq_mask		= crystalcove_irq_mask,
264 	.irq_unmask		= crystalcove_irq_unmask,
265 	.irq_set_type		= crystalcove_irq_type,
266 	.irq_bus_lock		= crystalcove_bus_lock,
267 	.irq_bus_sync_unlock	= crystalcove_bus_sync_unlock,
268 	.flags			= IRQCHIP_SKIP_SET_WAKE,
269 };
270 
271 static irqreturn_t crystalcove_gpio_irq_handler(int irq, void *data)
272 {
273 	struct crystalcove_gpio *cg = data;
274 	unsigned long pending;
275 	unsigned int p0, p1;
276 	int gpio;
277 	unsigned int virq;
278 
279 	if (regmap_read(cg->regmap, GPIO0IRQ, &p0) ||
280 	    regmap_read(cg->regmap, GPIO1IRQ, &p1))
281 		return IRQ_NONE;
282 
283 	regmap_write(cg->regmap, GPIO0IRQ, p0);
284 	regmap_write(cg->regmap, GPIO1IRQ, p1);
285 
286 	pending = p0 | p1 << 8;
287 
288 	for_each_set_bit(gpio, &pending, CRYSTALCOVE_GPIO_NUM) {
289 		virq = irq_find_mapping(cg->chip.irq.domain, gpio);
290 		handle_nested_irq(virq);
291 	}
292 
293 	return IRQ_HANDLED;
294 }
295 
296 static void crystalcove_gpio_dbg_show(struct seq_file *s,
297 				      struct gpio_chip *chip)
298 {
299 	struct crystalcove_gpio *cg = gpiochip_get_data(chip);
300 	int gpio, offset;
301 	unsigned int ctlo, ctli, mirqs0, mirqsx, irq;
302 
303 	for (gpio = 0; gpio < CRYSTALCOVE_GPIO_NUM; gpio++) {
304 		regmap_read(cg->regmap, to_reg(gpio, CTRL_OUT), &ctlo);
305 		regmap_read(cg->regmap, to_reg(gpio, CTRL_IN), &ctli);
306 		regmap_read(cg->regmap, gpio < 8 ? MGPIO0IRQS0 : MGPIO1IRQS0,
307 			    &mirqs0);
308 		regmap_read(cg->regmap, gpio < 8 ? MGPIO0IRQSX : MGPIO1IRQSX,
309 			    &mirqsx);
310 		regmap_read(cg->regmap, gpio < 8 ? GPIO0IRQ : GPIO1IRQ,
311 			    &irq);
312 
313 		offset = gpio % 8;
314 		seq_printf(s, " gpio-%-2d %s %s %s %s ctlo=%2x,%s %s %s\n",
315 			   gpio, ctlo & CTLO_DIR_OUT ? "out" : "in ",
316 			   ctli & 0x1 ? "hi" : "lo",
317 			   ctli & CTLI_INTCNT_NE ? "fall" : "    ",
318 			   ctli & CTLI_INTCNT_PE ? "rise" : "    ",
319 			   ctlo,
320 			   mirqs0 & BIT(offset) ? "s0 mask  " : "s0 unmask",
321 			   mirqsx & BIT(offset) ? "sx mask  " : "sx unmask",
322 			   irq & BIT(offset) ? "pending" : "       ");
323 	}
324 }
325 
326 static int crystalcove_gpio_probe(struct platform_device *pdev)
327 {
328 	int irq = platform_get_irq(pdev, 0);
329 	struct crystalcove_gpio *cg;
330 	int retval;
331 	struct device *dev = pdev->dev.parent;
332 	struct intel_soc_pmic *pmic = dev_get_drvdata(dev);
333 
334 	if (irq < 0)
335 		return irq;
336 
337 	cg = devm_kzalloc(&pdev->dev, sizeof(*cg), GFP_KERNEL);
338 	if (!cg)
339 		return -ENOMEM;
340 
341 	platform_set_drvdata(pdev, cg);
342 
343 	mutex_init(&cg->buslock);
344 	cg->chip.label = KBUILD_MODNAME;
345 	cg->chip.direction_input = crystalcove_gpio_dir_in;
346 	cg->chip.direction_output = crystalcove_gpio_dir_out;
347 	cg->chip.get = crystalcove_gpio_get;
348 	cg->chip.set = crystalcove_gpio_set;
349 	cg->chip.base = -1;
350 	cg->chip.ngpio = CRYSTALCOVE_VGPIO_NUM;
351 	cg->chip.can_sleep = true;
352 	cg->chip.parent = dev;
353 	cg->chip.dbg_show = crystalcove_gpio_dbg_show;
354 	cg->regmap = pmic->regmap;
355 
356 	retval = devm_gpiochip_add_data(&pdev->dev, &cg->chip, cg);
357 	if (retval) {
358 		dev_warn(&pdev->dev, "add gpio chip error: %d\n", retval);
359 		return retval;
360 	}
361 
362 	gpiochip_irqchip_add_nested(&cg->chip, &crystalcove_irqchip, 0,
363 				    handle_simple_irq, IRQ_TYPE_NONE);
364 
365 	retval = request_threaded_irq(irq, NULL, crystalcove_gpio_irq_handler,
366 				      IRQF_ONESHOT, KBUILD_MODNAME, cg);
367 
368 	if (retval) {
369 		dev_warn(&pdev->dev, "request irq failed: %d\n", retval);
370 		return retval;
371 	}
372 
373 	gpiochip_set_nested_irqchip(&cg->chip, &crystalcove_irqchip, irq);
374 
375 	return 0;
376 }
377 
378 static int crystalcove_gpio_remove(struct platform_device *pdev)
379 {
380 	struct crystalcove_gpio *cg = platform_get_drvdata(pdev);
381 	int irq = platform_get_irq(pdev, 0);
382 
383 	if (irq >= 0)
384 		free_irq(irq, cg);
385 	return 0;
386 }
387 
388 static struct platform_driver crystalcove_gpio_driver = {
389 	.probe = crystalcove_gpio_probe,
390 	.remove = crystalcove_gpio_remove,
391 	.driver = {
392 		.name = "crystal_cove_gpio",
393 	},
394 };
395 
396 module_platform_driver(crystalcove_gpio_driver);
397 
398 MODULE_AUTHOR("Yang, Bin <bin.yang@intel.com>");
399 MODULE_DESCRIPTION("Intel Crystal Cove GPIO Driver");
400 MODULE_LICENSE("GPL v2");
401