1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Nuvoton NPCM Serial GPIO Driver
4 *
5 * Copyright (C) 2021 Nuvoton Technologies
6 */
7
8#include <linux/bitfield.h>
9#include <linux/clk.h>
10#include <linux/gpio/driver.h>
11#include <linux/hashtable.h>
12#include <linux/init.h>
13#include <linux/io.h>
14#include <linux/module.h>
15#include <linux/platform_device.h>
16#include <linux/spinlock.h>
17#include <linux/string.h>
18#include <linux/units.h>
19
20#define MAX_NR_HW_SGPIO 64
21
22#define NPCM_IOXCFG1 0x2A
23#define NPCM_IOXCFG1_SFT_CLK GENMASK(3, 0)
24#define NPCM_IOXCFG1_SCLK_POL BIT(4)
25#define NPCM_IOXCFG1_LDSH_POL BIT(5)
26
27#define NPCM_IOXCTS 0x28
28#define NPCM_IOXCTS_IOXIF_EN BIT(7)
29#define NPCM_IOXCTS_RD_MODE GENMASK(2, 1)
30#define NPCM_IOXCTS_RD_MODE_PERIODIC BIT(2)
31
32#define NPCM_IOXCFG2 0x2B
33#define NPCM_IOXCFG2_PORT GENMASK(3, 0)
34
35#define NPCM_IXOEVCFG_MASK GENMASK(1, 0)
36#define NPCM_IXOEVCFG_FALLING BIT(1)
37#define NPCM_IXOEVCFG_RISING BIT(0)
38#define NPCM_IXOEVCFG_BOTH (NPCM_IXOEVCFG_FALLING | NPCM_IXOEVCFG_RISING)
39
40#define NPCM_CLK_MHZ (8 * HZ_PER_MHZ)
41#define NPCM_750_OPT 6
42#define NPCM_845_OPT 5
43
44#define GPIO_BANK(x) ((x) / 8)
45#define GPIO_BIT(x) ((x) % 8)
46
47/*
48 * Select the frequency of shift clock.
49 * The shift clock is a division of the APB clock.
50 */
51struct npcm_clk_cfg {
52 unsigned int *sft_clk;
53 unsigned int *clk_sel;
54 unsigned int cfg_opt;
55};
56
57struct npcm_sgpio {
58 struct gpio_chip chip;
59 struct clk *pclk;
60 struct irq_chip intc;
61 raw_spinlock_t lock;
62
63 void __iomem *base;
64 int irq;
65 u8 nin_sgpio;
66 u8 nout_sgpio;
67 u8 in_port;
68 u8 out_port;
69 u8 int_type[MAX_NR_HW_SGPIO];
70};
71
72struct npcm_sgpio_bank {
73 u8 rdata_reg;
74 u8 wdata_reg;
75 u8 event_config;
76 u8 event_status;
77};
78
79enum npcm_sgpio_reg {
80 READ_DATA,
81 WRITE_DATA,
82 EVENT_CFG,
83 EVENT_STS,
84};
85
86static const struct npcm_sgpio_bank npcm_sgpio_banks[] = {
87 {
88 .wdata_reg = 0x00,
89 .rdata_reg = 0x08,
90 .event_config = 0x10,
91 .event_status = 0x20,
92 },
93 {
94 .wdata_reg = 0x01,
95 .rdata_reg = 0x09,
96 .event_config = 0x12,
97 .event_status = 0x21,
98 },
99 {
100 .wdata_reg = 0x02,
101 .rdata_reg = 0x0a,
102 .event_config = 0x14,
103 .event_status = 0x22,
104 },
105 {
106 .wdata_reg = 0x03,
107 .rdata_reg = 0x0b,
108 .event_config = 0x16,
109 .event_status = 0x23,
110 },
111 {
112 .wdata_reg = 0x04,
113 .rdata_reg = 0x0c,
114 .event_config = 0x18,
115 .event_status = 0x24,
116 },
117 {
118 .wdata_reg = 0x05,
119 .rdata_reg = 0x0d,
120 .event_config = 0x1a,
121 .event_status = 0x25,
122 },
123 {
124 .wdata_reg = 0x06,
125 .rdata_reg = 0x0e,
126 .event_config = 0x1c,
127 .event_status = 0x26,
128 },
129 {
130 .wdata_reg = 0x07,
131 .rdata_reg = 0x0f,
132 .event_config = 0x1e,
133 .event_status = 0x27,
134 },
135};
136
137static void __iomem *bank_reg(struct npcm_sgpio *gpio,
138 const struct npcm_sgpio_bank *bank,
139 const enum npcm_sgpio_reg reg)
140{
141 switch (reg) {
142 case READ_DATA:
143 return gpio->base + bank->rdata_reg;
144 case WRITE_DATA:
145 return gpio->base + bank->wdata_reg;
146 case EVENT_CFG:
147 return gpio->base + bank->event_config;
148 case EVENT_STS:
149 return gpio->base + bank->event_status;
150 default:
151 /* actually if code runs to here, it's an error case */
152 dev_WARN(gpio->chip.parent, "Getting here is an error condition");
153 return NULL;
154 }
155}
156
157static const struct npcm_sgpio_bank *offset_to_bank(unsigned int offset)
158{
159 unsigned int bank = GPIO_BANK(offset);
160
161 return &npcm_sgpio_banks[bank];
162}
163
164static void npcm_sgpio_irqd_to_data(struct irq_data *d,
165 struct npcm_sgpio **gpio,
166 const struct npcm_sgpio_bank **bank,
167 u8 *bit, unsigned int *offset)
168{
169 struct npcm_sgpio *internal;
170
171 *offset = irqd_to_hwirq(d);
172 internal = irq_data_get_irq_chip_data(d);
173
174 *gpio = internal;
175 *offset -= internal->nout_sgpio;
176 *bank = offset_to_bank(offset: *offset);
177 *bit = GPIO_BIT(*offset);
178}
179
180static int npcm_sgpio_init_port(struct npcm_sgpio *gpio)
181{
182 u8 in_port, out_port, set_port, reg;
183
184 in_port = GPIO_BANK(gpio->nin_sgpio);
185 if (GPIO_BIT(gpio->nin_sgpio) > 0)
186 in_port += 1;
187
188 out_port = GPIO_BANK(gpio->nout_sgpio);
189 if (GPIO_BIT(gpio->nout_sgpio) > 0)
190 out_port += 1;
191
192 gpio->in_port = in_port;
193 gpio->out_port = out_port;
194 set_port = (out_port & NPCM_IOXCFG2_PORT) << 4 |
195 (in_port & NPCM_IOXCFG2_PORT);
196 iowrite8(set_port, gpio->base + NPCM_IOXCFG2);
197
198 reg = ioread8(gpio->base + NPCM_IOXCFG2);
199
200 return reg == set_port ? 0 : -EINVAL;
201
202}
203
204static int npcm_sgpio_dir_in(struct gpio_chip *gc, unsigned int offset)
205{
206 struct npcm_sgpio *gpio = gpiochip_get_data(gc);
207
208 return offset < gpio->nout_sgpio ? -EINVAL : 0;
209
210}
211
212static int npcm_sgpio_dir_out(struct gpio_chip *gc, unsigned int offset, int val)
213{
214 gc->set(gc, offset, val);
215
216 return 0;
217}
218
219static int npcm_sgpio_get_direction(struct gpio_chip *gc, unsigned int offset)
220{
221 struct npcm_sgpio *gpio = gpiochip_get_data(gc);
222
223 if (offset < gpio->nout_sgpio)
224 return GPIO_LINE_DIRECTION_OUT;
225
226 return GPIO_LINE_DIRECTION_IN;
227}
228
229static void npcm_sgpio_set(struct gpio_chip *gc, unsigned int offset, int val)
230{
231 struct npcm_sgpio *gpio = gpiochip_get_data(gc);
232 const struct npcm_sgpio_bank *bank = offset_to_bank(offset);
233 void __iomem *addr;
234 u8 reg = 0;
235
236 addr = bank_reg(gpio, bank, reg: WRITE_DATA);
237 reg = ioread8(addr);
238
239 if (val)
240 reg |= BIT(GPIO_BIT(offset));
241 else
242 reg &= ~BIT(GPIO_BIT(offset));
243
244 iowrite8(reg, addr);
245}
246
247static int npcm_sgpio_get(struct gpio_chip *gc, unsigned int offset)
248{
249 struct npcm_sgpio *gpio = gpiochip_get_data(gc);
250 const struct npcm_sgpio_bank *bank;
251 void __iomem *addr;
252 u8 reg;
253
254 if (offset < gpio->nout_sgpio) {
255 bank = offset_to_bank(offset);
256 addr = bank_reg(gpio, bank, reg: WRITE_DATA);
257 } else {
258 offset -= gpio->nout_sgpio;
259 bank = offset_to_bank(offset);
260 addr = bank_reg(gpio, bank, reg: READ_DATA);
261 }
262
263 reg = ioread8(addr);
264
265 return !!(reg & BIT(GPIO_BIT(offset)));
266}
267
268static void npcm_sgpio_setup_enable(struct npcm_sgpio *gpio, bool enable)
269{
270 u8 reg;
271
272 reg = ioread8(gpio->base + NPCM_IOXCTS);
273 reg = (reg & ~NPCM_IOXCTS_RD_MODE) | NPCM_IOXCTS_RD_MODE_PERIODIC;
274
275 if (enable)
276 reg |= NPCM_IOXCTS_IOXIF_EN;
277 else
278 reg &= ~NPCM_IOXCTS_IOXIF_EN;
279
280 iowrite8(reg, gpio->base + NPCM_IOXCTS);
281}
282
283static int npcm_sgpio_setup_clk(struct npcm_sgpio *gpio,
284 const struct npcm_clk_cfg *clk_cfg)
285{
286 unsigned long apb_freq;
287 u32 val;
288 u8 tmp;
289 int i;
290
291 apb_freq = clk_get_rate(clk: gpio->pclk);
292 tmp = ioread8(gpio->base + NPCM_IOXCFG1) & ~NPCM_IOXCFG1_SFT_CLK;
293
294 for (i = clk_cfg->cfg_opt-1; i > 0; i--) {
295 val = apb_freq / clk_cfg->sft_clk[i];
296 if (NPCM_CLK_MHZ > val) {
297 iowrite8(clk_cfg->clk_sel[i] | tmp,
298 gpio->base + NPCM_IOXCFG1);
299 return 0;
300 }
301 }
302
303 return -EINVAL;
304}
305
306static void npcm_sgpio_irq_init_valid_mask(struct gpio_chip *gc,
307 unsigned long *valid_mask,
308 unsigned int ngpios)
309{
310 struct npcm_sgpio *gpio = gpiochip_get_data(gc);
311
312 /* input GPIOs in the high range */
313 bitmap_set(map: valid_mask, start: gpio->nout_sgpio, nbits: gpio->nin_sgpio);
314 bitmap_clear(map: valid_mask, start: 0, nbits: gpio->nout_sgpio);
315}
316
317static void npcm_sgpio_irq_set_mask(struct irq_data *d, bool set)
318{
319 const struct npcm_sgpio_bank *bank;
320 struct npcm_sgpio *gpio;
321 unsigned long flags;
322 void __iomem *addr;
323 unsigned int offset;
324 u16 reg, type;
325 u8 bit;
326
327 npcm_sgpio_irqd_to_data(d, gpio: &gpio, bank: &bank, bit: &bit, offset: &offset);
328 addr = bank_reg(gpio, bank, reg: EVENT_CFG);
329
330 reg = ioread16(addr);
331 if (set) {
332 reg &= ~(NPCM_IXOEVCFG_MASK << (bit * 2));
333 } else {
334 type = gpio->int_type[offset];
335 reg |= (type << (bit * 2));
336 }
337
338 raw_spin_lock_irqsave(&gpio->lock, flags);
339
340 npcm_sgpio_setup_enable(gpio, enable: false);
341
342 iowrite16(reg, addr);
343
344 npcm_sgpio_setup_enable(gpio, enable: true);
345
346 addr = bank_reg(gpio, bank, reg: EVENT_STS);
347 reg = ioread8(addr);
348 reg |= BIT(bit);
349 iowrite8(reg, addr);
350
351 raw_spin_unlock_irqrestore(&gpio->lock, flags);
352}
353
354static void npcm_sgpio_irq_ack(struct irq_data *d)
355{
356 const struct npcm_sgpio_bank *bank;
357 struct npcm_sgpio *gpio;
358 unsigned long flags;
359 void __iomem *status_addr;
360 unsigned int offset;
361 u8 bit;
362
363 npcm_sgpio_irqd_to_data(d, gpio: &gpio, bank: &bank, bit: &bit, offset: &offset);
364 status_addr = bank_reg(gpio, bank, reg: EVENT_STS);
365 raw_spin_lock_irqsave(&gpio->lock, flags);
366 iowrite8(BIT(bit), status_addr);
367 raw_spin_unlock_irqrestore(&gpio->lock, flags);
368}
369
370static void npcm_sgpio_irq_mask(struct irq_data *d)
371{
372 npcm_sgpio_irq_set_mask(d, set: true);
373}
374
375static void npcm_sgpio_irq_unmask(struct irq_data *d)
376{
377 npcm_sgpio_irq_set_mask(d, set: false);
378}
379
380static int npcm_sgpio_set_type(struct irq_data *d, unsigned int type)
381{
382 const struct npcm_sgpio_bank *bank;
383 irq_flow_handler_t handler;
384 struct npcm_sgpio *gpio;
385 unsigned long flags;
386 void __iomem *addr;
387 unsigned int offset;
388 u16 reg, val;
389 u8 bit;
390
391 npcm_sgpio_irqd_to_data(d, gpio: &gpio, bank: &bank, bit: &bit, offset: &offset);
392
393 switch (type & IRQ_TYPE_SENSE_MASK) {
394 case IRQ_TYPE_EDGE_BOTH:
395 val = NPCM_IXOEVCFG_BOTH;
396 break;
397 case IRQ_TYPE_EDGE_RISING:
398 case IRQ_TYPE_LEVEL_HIGH:
399 val = NPCM_IXOEVCFG_RISING;
400 break;
401 case IRQ_TYPE_EDGE_FALLING:
402 case IRQ_TYPE_LEVEL_LOW:
403 val = NPCM_IXOEVCFG_FALLING;
404 break;
405 default:
406 return -EINVAL;
407 }
408
409 if (type & IRQ_TYPE_LEVEL_MASK)
410 handler = handle_level_irq;
411 else
412 handler = handle_edge_irq;
413
414 gpio->int_type[offset] = val;
415
416 raw_spin_lock_irqsave(&gpio->lock, flags);
417 npcm_sgpio_setup_enable(gpio, enable: false);
418 addr = bank_reg(gpio, bank, reg: EVENT_CFG);
419 reg = ioread16(addr);
420
421 reg |= (val << (bit * 2));
422
423 iowrite16(reg, addr);
424 npcm_sgpio_setup_enable(gpio, enable: true);
425 raw_spin_unlock_irqrestore(&gpio->lock, flags);
426
427 irq_set_handler_locked(data: d, handler);
428
429 return 0;
430}
431
432static void npcm_sgpio_irq_handler(struct irq_desc *desc)
433{
434 struct gpio_chip *gc = irq_desc_get_handler_data(desc);
435 struct irq_chip *ic = irq_desc_get_chip(desc);
436 struct npcm_sgpio *gpio = gpiochip_get_data(gc);
437 unsigned int i, j, girq;
438 unsigned long reg;
439
440 chained_irq_enter(chip: ic, desc);
441
442 for (i = 0; i < ARRAY_SIZE(npcm_sgpio_banks); i++) {
443 const struct npcm_sgpio_bank *bank = &npcm_sgpio_banks[i];
444
445 reg = ioread8(bank_reg(gpio, bank, reg: EVENT_STS));
446 for_each_set_bit(j, &reg, 8) {
447 girq = irq_find_mapping(domain: gc->irq.domain,
448 hwirq: i * 8 + gpio->nout_sgpio + j);
449 generic_handle_domain_irq(domain: gc->irq.domain, hwirq: girq);
450 }
451 }
452
453 chained_irq_exit(chip: ic, desc);
454}
455
456static const struct irq_chip sgpio_irq_chip = {
457 .name = "sgpio-irq",
458 .irq_ack = npcm_sgpio_irq_ack,
459 .irq_mask = npcm_sgpio_irq_mask,
460 .irq_unmask = npcm_sgpio_irq_unmask,
461 .irq_set_type = npcm_sgpio_set_type,
462 .flags = IRQCHIP_IMMUTABLE | IRQCHIP_MASK_ON_SUSPEND,
463 GPIOCHIP_IRQ_RESOURCE_HELPERS,
464};
465
466static int npcm_sgpio_setup_irqs(struct npcm_sgpio *gpio,
467 struct platform_device *pdev)
468{
469 int rc, i;
470 struct gpio_irq_chip *irq;
471
472 rc = platform_get_irq(pdev, 0);
473 if (rc < 0)
474 return rc;
475
476 gpio->irq = rc;
477
478 npcm_sgpio_setup_enable(gpio, enable: false);
479
480 /* Disable IRQ and clear Interrupt status registers for all SGPIO Pins. */
481 for (i = 0; i < ARRAY_SIZE(npcm_sgpio_banks); i++) {
482 const struct npcm_sgpio_bank *bank = &npcm_sgpio_banks[i];
483
484 iowrite16(0, bank_reg(gpio, bank, reg: EVENT_CFG));
485 iowrite8(0xff, bank_reg(gpio, bank, reg: EVENT_STS));
486 }
487
488 irq = &gpio->chip.irq;
489 gpio_irq_chip_set_chip(girq: irq, chip: &sgpio_irq_chip);
490 irq->init_valid_mask = npcm_sgpio_irq_init_valid_mask;
491 irq->handler = handle_bad_irq;
492 irq->default_type = IRQ_TYPE_NONE;
493 irq->parent_handler = npcm_sgpio_irq_handler;
494 irq->parent_handler_data = gpio;
495 irq->parents = &gpio->irq;
496 irq->num_parents = 1;
497
498 return 0;
499}
500
501static int npcm_sgpio_probe(struct platform_device *pdev)
502{
503 struct npcm_sgpio *gpio;
504 const struct npcm_clk_cfg *clk_cfg;
505 int rc;
506 u32 nin_gpios, nout_gpios;
507
508 gpio = devm_kzalloc(dev: &pdev->dev, size: sizeof(*gpio), GFP_KERNEL);
509 if (!gpio)
510 return -ENOMEM;
511
512 gpio->base = devm_platform_ioremap_resource(pdev, index: 0);
513 if (IS_ERR(ptr: gpio->base))
514 return PTR_ERR(ptr: gpio->base);
515
516 clk_cfg = device_get_match_data(dev: &pdev->dev);
517 if (!clk_cfg)
518 return -EINVAL;
519
520 rc = device_property_read_u32(dev: &pdev->dev, propname: "nuvoton,input-ngpios",
521 val: &nin_gpios);
522 if (rc < 0)
523 return dev_err_probe(dev: &pdev->dev, err: rc, fmt: "Could not read ngpios property\n");
524
525 rc = device_property_read_u32(dev: &pdev->dev, propname: "nuvoton,output-ngpios",
526 val: &nout_gpios);
527 if (rc < 0)
528 return dev_err_probe(dev: &pdev->dev, err: rc, fmt: "Could not read ngpios property\n");
529
530 gpio->nin_sgpio = nin_gpios;
531 gpio->nout_sgpio = nout_gpios;
532 if (gpio->nin_sgpio > MAX_NR_HW_SGPIO ||
533 gpio->nout_sgpio > MAX_NR_HW_SGPIO)
534 return dev_err_probe(dev: &pdev->dev, err: -EINVAL, fmt: "Number of GPIOs exceeds the maximum of %d: input: %d output: %d\n", MAX_NR_HW_SGPIO, nin_gpios, nout_gpios);
535
536 gpio->pclk = devm_clk_get(dev: &pdev->dev, NULL);
537 if (IS_ERR(ptr: gpio->pclk))
538 return dev_err_probe(dev: &pdev->dev, err: PTR_ERR(ptr: gpio->pclk), fmt: "Could not get pclk\n");
539
540 rc = npcm_sgpio_setup_clk(gpio, clk_cfg);
541 if (rc < 0)
542 return dev_err_probe(dev: &pdev->dev, err: rc, fmt: "Failed to setup clock\n");
543
544 raw_spin_lock_init(&gpio->lock);
545 gpio->chip.parent = &pdev->dev;
546 gpio->chip.ngpio = gpio->nin_sgpio + gpio->nout_sgpio;
547 gpio->chip.direction_input = npcm_sgpio_dir_in;
548 gpio->chip.direction_output = npcm_sgpio_dir_out;
549 gpio->chip.get_direction = npcm_sgpio_get_direction;
550 gpio->chip.get = npcm_sgpio_get;
551 gpio->chip.set = npcm_sgpio_set;
552 gpio->chip.label = dev_name(dev: &pdev->dev);
553 gpio->chip.base = -1;
554
555 rc = npcm_sgpio_init_port(gpio);
556 if (rc < 0)
557 return rc;
558
559 rc = npcm_sgpio_setup_irqs(gpio, pdev);
560 if (rc < 0)
561 return rc;
562
563 rc = devm_gpiochip_add_data(&pdev->dev, &gpio->chip, gpio);
564 if (rc)
565 return dev_err_probe(dev: &pdev->dev, err: rc, fmt: "GPIO registering failed\n");
566
567 npcm_sgpio_setup_enable(gpio, enable: true);
568
569 return 0;
570}
571
572static unsigned int npcm750_SFT_CLK[NPCM_750_OPT] = {
573 1024, 32, 8, 4, 3, 2,
574};
575
576static unsigned int npcm750_CLK_SEL[NPCM_750_OPT] = {
577 0x00, 0x05, 0x07, 0x0C, 0x0D, 0x0E,
578};
579
580static unsigned int npcm845_SFT_CLK[NPCM_845_OPT] = {
581 1024, 32, 16, 8, 4,
582};
583
584static unsigned int npcm845_CLK_SEL[NPCM_845_OPT] = {
585 0x00, 0x05, 0x06, 0x07, 0x0C,
586};
587
588static struct npcm_clk_cfg npcm750_sgpio_pdata = {
589 .sft_clk = npcm750_SFT_CLK,
590 .clk_sel = npcm750_CLK_SEL,
591 .cfg_opt = NPCM_750_OPT,
592};
593
594static const struct npcm_clk_cfg npcm845_sgpio_pdata = {
595 .sft_clk = npcm845_SFT_CLK,
596 .clk_sel = npcm845_CLK_SEL,
597 .cfg_opt = NPCM_845_OPT,
598};
599
600static const struct of_device_id npcm_sgpio_of_table[] = {
601 { .compatible = "nuvoton,npcm750-sgpio", .data = &npcm750_sgpio_pdata, },
602 { .compatible = "nuvoton,npcm845-sgpio", .data = &npcm845_sgpio_pdata, },
603 {}
604};
605MODULE_DEVICE_TABLE(of, npcm_sgpio_of_table);
606
607static struct platform_driver npcm_sgpio_driver = {
608 .driver = {
609 .name = KBUILD_MODNAME,
610 .of_match_table = npcm_sgpio_of_table,
611 },
612 .probe = npcm_sgpio_probe,
613};
614module_platform_driver(npcm_sgpio_driver);
615
616MODULE_AUTHOR("Jim Liu <jjliu0@nuvoton.com>");
617MODULE_AUTHOR("Joseph Liu <kwliu@nuvoton.com>");
618MODULE_DESCRIPTION("Nuvoton NPCM Serial GPIO Driver");
619MODULE_LICENSE("GPL v2");
620

source code of linux/drivers/gpio/gpio-npcm-sgpio.c