Lines Matching full:pc
244 static inline u32 bcm2835_gpio_rd(struct bcm2835_pinctrl *pc, unsigned reg) in bcm2835_gpio_rd() argument
246 return readl(pc->base + reg); in bcm2835_gpio_rd()
249 static inline void bcm2835_gpio_wr(struct bcm2835_pinctrl *pc, unsigned reg, in bcm2835_gpio_wr() argument
252 writel(val, pc->base + reg); in bcm2835_gpio_wr()
255 static inline int bcm2835_gpio_get_bit(struct bcm2835_pinctrl *pc, unsigned reg, in bcm2835_gpio_get_bit() argument
259 return (bcm2835_gpio_rd(pc, reg) >> GPIO_REG_SHIFT(bit)) & 1; in bcm2835_gpio_get_bit()
263 static inline void bcm2835_gpio_set_bit(struct bcm2835_pinctrl *pc, in bcm2835_gpio_set_bit() argument
267 bcm2835_gpio_wr(pc, reg, BIT(GPIO_REG_SHIFT(bit))); in bcm2835_gpio_set_bit()
271 struct bcm2835_pinctrl *pc, unsigned pin) in bcm2835_pinctrl_fsel_get() argument
273 u32 val = bcm2835_gpio_rd(pc, FSEL_REG(pin)); in bcm2835_pinctrl_fsel_get()
276 dev_dbg(pc->dev, "get %08x (%u => %s)\n", val, pin, in bcm2835_pinctrl_fsel_get()
283 struct bcm2835_pinctrl *pc, unsigned pin, in bcm2835_pinctrl_fsel_set() argument
286 u32 val = bcm2835_gpio_rd(pc, FSEL_REG(pin)); in bcm2835_pinctrl_fsel_set()
289 dev_dbg(pc->dev, "read %08x (%u => %s)\n", val, pin, in bcm2835_pinctrl_fsel_set()
300 dev_dbg(pc->dev, "trans %08x (%u <= %s)\n", val, pin, in bcm2835_pinctrl_fsel_set()
302 bcm2835_gpio_wr(pc, FSEL_REG(pin), val); in bcm2835_pinctrl_fsel_set()
308 dev_dbg(pc->dev, "write %08x (%u <= %s)\n", val, pin, in bcm2835_pinctrl_fsel_set()
310 bcm2835_gpio_wr(pc, FSEL_REG(pin), val); in bcm2835_pinctrl_fsel_set()
320 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_get() local
322 return bcm2835_gpio_get_bit(pc, GPLEV0, offset); in bcm2835_gpio_get()
327 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_get_direction() local
328 enum bcm2835_fsel fsel = bcm2835_pinctrl_fsel_get(pc, offset); in bcm2835_gpio_get_direction()
342 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_set() local
344 bcm2835_gpio_set_bit(pc, value ? GPSET0 : GPCLR0, offset); in bcm2835_gpio_set()
386 static void bcm2835_gpio_irq_handle_bank(struct bcm2835_pinctrl *pc, in bcm2835_gpio_irq_handle_bank() argument
393 events = bcm2835_gpio_rd(pc, GPEDS0 + bank * 4); in bcm2835_gpio_irq_handle_bank()
395 events &= pc->enabled_irq_map[bank]; in bcm2835_gpio_irq_handle_bank()
398 generic_handle_domain_irq(pc->gpio_chip.irq.domain, in bcm2835_gpio_irq_handle_bank()
406 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_handler() local
425 bcm2835_gpio_irq_handle_bank(pc, 0, 0x0fffffff); in bcm2835_gpio_irq_handler()
428 bcm2835_gpio_irq_handle_bank(pc, 0, 0xf0000000); in bcm2835_gpio_irq_handler()
429 bcm2835_gpio_irq_handle_bank(pc, 1, 0x00003fff); in bcm2835_gpio_irq_handler()
432 bcm2835_gpio_irq_handle_bank(pc, 1, 0x003fc000); in bcm2835_gpio_irq_handler()
444 static inline void __bcm2835_gpio_irq_config(struct bcm2835_pinctrl *pc, in __bcm2835_gpio_irq_config() argument
449 value = bcm2835_gpio_rd(pc, reg); in __bcm2835_gpio_irq_config()
454 bcm2835_gpio_wr(pc, reg, value); in __bcm2835_gpio_irq_config()
458 static void bcm2835_gpio_irq_config(struct bcm2835_pinctrl *pc, in bcm2835_gpio_irq_config() argument
461 switch (pc->irq_type[offset]) { in bcm2835_gpio_irq_config()
463 __bcm2835_gpio_irq_config(pc, GPREN0, offset, enable); in bcm2835_gpio_irq_config()
467 __bcm2835_gpio_irq_config(pc, GPFEN0, offset, enable); in bcm2835_gpio_irq_config()
471 __bcm2835_gpio_irq_config(pc, GPREN0, offset, enable); in bcm2835_gpio_irq_config()
472 __bcm2835_gpio_irq_config(pc, GPFEN0, offset, enable); in bcm2835_gpio_irq_config()
476 __bcm2835_gpio_irq_config(pc, GPHEN0, offset, enable); in bcm2835_gpio_irq_config()
480 __bcm2835_gpio_irq_config(pc, GPLEN0, offset, enable); in bcm2835_gpio_irq_config()
488 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_enable() local
494 raw_spin_lock_irqsave(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_enable()
495 set_bit(offset, &pc->enabled_irq_map[bank]); in bcm2835_gpio_irq_enable()
496 bcm2835_gpio_irq_config(pc, gpio, true); in bcm2835_gpio_irq_enable()
497 raw_spin_unlock_irqrestore(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_enable()
503 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_disable() local
509 raw_spin_lock_irqsave(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_disable()
510 bcm2835_gpio_irq_config(pc, gpio, false); in bcm2835_gpio_irq_disable()
512 bcm2835_gpio_set_bit(pc, GPEDS0, gpio); in bcm2835_gpio_irq_disable()
513 clear_bit(offset, &pc->enabled_irq_map[bank]); in bcm2835_gpio_irq_disable()
514 raw_spin_unlock_irqrestore(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_disable()
517 static int __bcm2835_gpio_irq_set_type_disabled(struct bcm2835_pinctrl *pc, in __bcm2835_gpio_irq_set_type_disabled() argument
527 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_disabled()
537 static int __bcm2835_gpio_irq_set_type_enabled(struct bcm2835_pinctrl *pc, in __bcm2835_gpio_irq_set_type_enabled() argument
542 if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
543 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
544 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
549 if (pc->irq_type[offset] == IRQ_TYPE_EDGE_BOTH) { in __bcm2835_gpio_irq_set_type_enabled()
551 pc->irq_type[offset] = IRQ_TYPE_EDGE_FALLING; in __bcm2835_gpio_irq_set_type_enabled()
552 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
553 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
554 } else if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
555 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
556 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
557 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
562 if (pc->irq_type[offset] == IRQ_TYPE_EDGE_BOTH) { in __bcm2835_gpio_irq_set_type_enabled()
564 pc->irq_type[offset] = IRQ_TYPE_EDGE_RISING; in __bcm2835_gpio_irq_set_type_enabled()
565 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
566 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
567 } else if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
568 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
569 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
570 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
575 if (pc->irq_type[offset] == IRQ_TYPE_EDGE_RISING) { in __bcm2835_gpio_irq_set_type_enabled()
577 pc->irq_type[offset] = IRQ_TYPE_EDGE_FALLING; in __bcm2835_gpio_irq_set_type_enabled()
578 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
579 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
580 } else if (pc->irq_type[offset] == IRQ_TYPE_EDGE_FALLING) { in __bcm2835_gpio_irq_set_type_enabled()
582 pc->irq_type[offset] = IRQ_TYPE_EDGE_RISING; in __bcm2835_gpio_irq_set_type_enabled()
583 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
584 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
585 } else if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
586 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
587 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
588 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
594 if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
595 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
596 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
597 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
610 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_set_type() local
617 raw_spin_lock_irqsave(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_set_type()
619 if (test_bit(offset, &pc->enabled_irq_map[bank])) in bcm2835_gpio_irq_set_type()
620 ret = __bcm2835_gpio_irq_set_type_enabled(pc, gpio, type); in bcm2835_gpio_irq_set_type()
622 ret = __bcm2835_gpio_irq_set_type_disabled(pc, gpio, type); in bcm2835_gpio_irq_set_type()
629 raw_spin_unlock_irqrestore(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_set_type()
637 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_ack() local
640 bcm2835_gpio_set_bit(pc, GPEDS0, gpio); in bcm2835_gpio_irq_ack()
646 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_set_wake() local
651 if (!pc->wake_irq) in bcm2835_gpio_irq_set_wake()
664 ret = enable_irq_wake(pc->wake_irq[irqgroup]); in bcm2835_gpio_irq_set_wake()
666 ret = disable_irq_wake(pc->wake_irq[irqgroup]); in bcm2835_gpio_irq_set_wake()
709 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pctl_pin_dbg_show() local
710 struct gpio_chip *chip = &pc->gpio_chip; in bcm2835_pctl_pin_dbg_show()
711 enum bcm2835_fsel fsel = bcm2835_pinctrl_fsel_get(pc, offset); in bcm2835_pctl_pin_dbg_show()
713 int value = bcm2835_gpio_get_bit(pc, GPLEV0, offset); in bcm2835_pctl_pin_dbg_show()
718 irq, irq_type_names[pc->irq_type[offset]]); in bcm2835_pctl_pin_dbg_show()
733 static int bcm2835_pctl_dt_node_to_map_func(struct bcm2835_pinctrl *pc, in bcm2835_pctl_dt_node_to_map_func() argument
740 dev_err(pc->dev, "%pOF: invalid brcm,function %d\n", np, fnum); in bcm2835_pctl_dt_node_to_map_func()
752 static int bcm2835_pctl_dt_node_to_map_pull(struct bcm2835_pinctrl *pc, in bcm2835_pctl_dt_node_to_map_pull() argument
760 dev_err(pc->dev, "%pOF: invalid brcm,pull %d\n", np, pull); in bcm2835_pctl_dt_node_to_map_pull()
782 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pctl_dt_node_to_map() local
797 dev_err(pc->dev, "%pOF: missing brcm,pins property\n", np); in bcm2835_pctl_dt_node_to_map()
805 dev_err(pc->dev, in bcm2835_pctl_dt_node_to_map()
816 dev_err(pc->dev, in bcm2835_pctl_dt_node_to_map()
823 dev_err(pc->dev, in bcm2835_pctl_dt_node_to_map()
843 if (pin >= pc->pctl_desc.npins) { in bcm2835_pctl_dt_node_to_map()
844 dev_err(pc->dev, "%pOF: invalid brcm,pins value %d\n", in bcm2835_pctl_dt_node_to_map()
855 err = bcm2835_pctl_dt_node_to_map_func(pc, np, pin, in bcm2835_pctl_dt_node_to_map()
865 err = bcm2835_pctl_dt_node_to_map_pull(pc, np, pin, in bcm2835_pctl_dt_node_to_map()
894 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_free() local
897 bcm2835_pinctrl_fsel_set(pc, offset, BCM2835_FSEL_GPIO_IN); in bcm2835_pmx_free()
928 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_set() local
930 bcm2835_pinctrl_fsel_set(pc, group_selector, func_selector); in bcm2835_pmx_set()
939 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_gpio_disable_free() local
942 bcm2835_pinctrl_fsel_set(pc, offset, BCM2835_FSEL_GPIO_IN); in bcm2835_pmx_gpio_disable_free()
950 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_gpio_set_direction() local
954 bcm2835_pinctrl_fsel_set(pc, offset, fsel); in bcm2835_pmx_gpio_set_direction()
976 static void bcm2835_pull_config_set(struct bcm2835_pinctrl *pc, in bcm2835_pull_config_set() argument
984 bcm2835_gpio_wr(pc, GPPUD, arg & 3); in bcm2835_pull_config_set()
992 bcm2835_gpio_wr(pc, GPPUDCLK0 + (off * 4), BIT(bit)); in bcm2835_pull_config_set()
994 bcm2835_gpio_wr(pc, GPPUDCLK0 + (off * 4), 0); in bcm2835_pull_config_set()
1001 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pinconf_set() local
1012 bcm2835_pull_config_set(pc, pin, arg); in bcm2835_pinconf_set()
1017 bcm2835_pull_config_set(pc, pin, BCM2835_PUD_OFF); in bcm2835_pinconf_set()
1021 bcm2835_pull_config_set(pc, pin, BCM2835_PUD_DOWN); in bcm2835_pinconf_set()
1025 bcm2835_pull_config_set(pc, pin, BCM2835_PUD_UP); in bcm2835_pinconf_set()
1030 bcm2835_gpio_set_bit(pc, arg ? GPSET0 : GPCLR0, pin); in bcm2835_pinconf_set()
1048 static void bcm2711_pull_config_set(struct bcm2835_pinctrl *pc, in bcm2711_pull_config_set() argument
1058 value = bcm2835_gpio_rd(pc, GP_GPIO_PUP_PDN_CNTRL_REG0 + (off * 4)); in bcm2711_pull_config_set()
1061 bcm2835_gpio_wr(pc, GP_GPIO_PUP_PDN_CNTRL_REG0 + (off * 4), value); in bcm2711_pull_config_set()
1068 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2711_pinconf_set() local
1086 bcm2711_pull_config_set(pc, pin, arg); in bcm2711_pinconf_set()
1091 bcm2711_pull_config_set(pc, pin, BCM2711_PULL_NONE); in bcm2711_pinconf_set()
1094 bcm2711_pull_config_set(pc, pin, BCM2711_PULL_DOWN); in bcm2711_pinconf_set()
1097 bcm2711_pull_config_set(pc, pin, BCM2711_PULL_UP); in bcm2711_pinconf_set()
1102 bcm2835_gpio_set_bit(pc, arg ? GPSET0 : GPCLR0, pin); in bcm2711_pinconf_set()
1188 struct bcm2835_pinctrl *pc; in bcm2835_pinctrl_probe() local
1198 pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL); in bcm2835_pinctrl_probe()
1199 if (!pc) in bcm2835_pinctrl_probe()
1202 platform_set_drvdata(pdev, pc); in bcm2835_pinctrl_probe()
1203 pc->dev = dev; in bcm2835_pinctrl_probe()
1211 pc->base = devm_ioremap_resource(dev, &iomem); in bcm2835_pinctrl_probe()
1212 if (IS_ERR(pc->base)) in bcm2835_pinctrl_probe()
1213 return PTR_ERR(pc->base); in bcm2835_pinctrl_probe()
1222 pc->gpio_chip = *pdata->gpio_chip; in bcm2835_pinctrl_probe()
1223 pc->gpio_chip.parent = dev; in bcm2835_pinctrl_probe()
1224 pc->gpio_chip.of_node = np; in bcm2835_pinctrl_probe()
1231 bcm2835_gpio_wr(pc, GPREN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1232 bcm2835_gpio_wr(pc, GPFEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1233 bcm2835_gpio_wr(pc, GPHEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1234 bcm2835_gpio_wr(pc, GPLEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1235 bcm2835_gpio_wr(pc, GPAREN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1236 bcm2835_gpio_wr(pc, GPAFEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1239 events = bcm2835_gpio_rd(pc, GPEDS0 + i * 4); in bcm2835_pinctrl_probe()
1241 bcm2835_gpio_wr(pc, GPEDS0 + i * 4, BIT(offset)); in bcm2835_pinctrl_probe()
1243 raw_spin_lock_init(&pc->irq_lock[i]); in bcm2835_pinctrl_probe()
1246 girq = &pc->gpio_chip.irq; in bcm2835_pinctrl_probe()
1257 pc->wake_irq = devm_kcalloc(dev, BCM2835_NUM_IRQS, in bcm2835_pinctrl_probe()
1258 sizeof(*pc->wake_irq), in bcm2835_pinctrl_probe()
1260 if (!pc->wake_irq) in bcm2835_pinctrl_probe()
1284 pc->wake_irq[i] = irq_of_parse_and_map(np, i + in bcm2835_pinctrl_probe()
1287 len = strlen(dev_name(pc->dev)) + 16; in bcm2835_pinctrl_probe()
1288 name = devm_kzalloc(pc->dev, len, GFP_KERNEL); in bcm2835_pinctrl_probe()
1292 snprintf(name, len, "%s:bank%d", dev_name(pc->dev), i); in bcm2835_pinctrl_probe()
1295 err = devm_request_irq(dev, pc->wake_irq[i], in bcm2835_pinctrl_probe()
1297 IRQF_SHARED, name, pc); in bcm2835_pinctrl_probe()
1300 pc->wake_irq[i]); in bcm2835_pinctrl_probe()
1306 err = gpiochip_add_data(&pc->gpio_chip, pc); in bcm2835_pinctrl_probe()
1312 pc->pctl_desc = *pdata->pctl_desc; in bcm2835_pinctrl_probe()
1313 pc->pctl_dev = devm_pinctrl_register(dev, &pc->pctl_desc, pc); in bcm2835_pinctrl_probe()
1314 if (IS_ERR(pc->pctl_dev)) { in bcm2835_pinctrl_probe()
1315 gpiochip_remove(&pc->gpio_chip); in bcm2835_pinctrl_probe()
1316 return PTR_ERR(pc->pctl_dev); in bcm2835_pinctrl_probe()
1319 pc->gpio_range = *pdata->gpio_range; in bcm2835_pinctrl_probe()
1320 pc->gpio_range.base = pc->gpio_chip.base; in bcm2835_pinctrl_probe()
1321 pc->gpio_range.gc = &pc->gpio_chip; in bcm2835_pinctrl_probe()
1322 pinctrl_add_gpio_range(pc->pctl_dev, &pc->gpio_range); in bcm2835_pinctrl_probe()