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_irq(irq_linear_revmap(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
426 bcm2835_gpio_irq_handle_bank(pc, 0, 0x0fffffff); in bcm2835_gpio_irq_handler()
429 bcm2835_gpio_irq_handle_bank(pc, 0, 0xf0000000); in bcm2835_gpio_irq_handler()
430 bcm2835_gpio_irq_handle_bank(pc, 1, 0x00003fff); in bcm2835_gpio_irq_handler()
433 bcm2835_gpio_irq_handle_bank(pc, 1, 0x003fc000); in bcm2835_gpio_irq_handler()
445 static inline void __bcm2835_gpio_irq_config(struct bcm2835_pinctrl *pc, in __bcm2835_gpio_irq_config() argument
450 value = bcm2835_gpio_rd(pc, reg); in __bcm2835_gpio_irq_config()
455 bcm2835_gpio_wr(pc, reg, value); in __bcm2835_gpio_irq_config()
459 static void bcm2835_gpio_irq_config(struct bcm2835_pinctrl *pc, in bcm2835_gpio_irq_config() argument
462 switch (pc->irq_type[offset]) { in bcm2835_gpio_irq_config()
464 __bcm2835_gpio_irq_config(pc, GPREN0, offset, enable); in bcm2835_gpio_irq_config()
468 __bcm2835_gpio_irq_config(pc, GPFEN0, offset, enable); in bcm2835_gpio_irq_config()
472 __bcm2835_gpio_irq_config(pc, GPREN0, offset, enable); in bcm2835_gpio_irq_config()
473 __bcm2835_gpio_irq_config(pc, GPFEN0, offset, enable); in bcm2835_gpio_irq_config()
477 __bcm2835_gpio_irq_config(pc, GPHEN0, offset, enable); in bcm2835_gpio_irq_config()
481 __bcm2835_gpio_irq_config(pc, GPLEN0, offset, enable); in bcm2835_gpio_irq_config()
489 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_enable() local
495 raw_spin_lock_irqsave(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_enable()
496 set_bit(offset, &pc->enabled_irq_map[bank]); in bcm2835_gpio_irq_enable()
497 bcm2835_gpio_irq_config(pc, gpio, true); in bcm2835_gpio_irq_enable()
498 raw_spin_unlock_irqrestore(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_enable()
504 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_disable() local
510 raw_spin_lock_irqsave(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_disable()
511 bcm2835_gpio_irq_config(pc, gpio, false); in bcm2835_gpio_irq_disable()
513 bcm2835_gpio_set_bit(pc, GPEDS0, gpio); in bcm2835_gpio_irq_disable()
514 clear_bit(offset, &pc->enabled_irq_map[bank]); in bcm2835_gpio_irq_disable()
515 raw_spin_unlock_irqrestore(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_disable()
518 static int __bcm2835_gpio_irq_set_type_disabled(struct bcm2835_pinctrl *pc, in __bcm2835_gpio_irq_set_type_disabled() argument
528 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_disabled()
538 static int __bcm2835_gpio_irq_set_type_enabled(struct bcm2835_pinctrl *pc, in __bcm2835_gpio_irq_set_type_enabled() argument
543 if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
544 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
545 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
550 if (pc->irq_type[offset] == IRQ_TYPE_EDGE_BOTH) { in __bcm2835_gpio_irq_set_type_enabled()
552 pc->irq_type[offset] = IRQ_TYPE_EDGE_FALLING; in __bcm2835_gpio_irq_set_type_enabled()
553 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
554 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
555 } else if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
556 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
557 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
558 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
563 if (pc->irq_type[offset] == IRQ_TYPE_EDGE_BOTH) { in __bcm2835_gpio_irq_set_type_enabled()
565 pc->irq_type[offset] = IRQ_TYPE_EDGE_RISING; in __bcm2835_gpio_irq_set_type_enabled()
566 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
567 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
568 } else if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
569 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
570 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
571 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
576 if (pc->irq_type[offset] == IRQ_TYPE_EDGE_RISING) { in __bcm2835_gpio_irq_set_type_enabled()
578 pc->irq_type[offset] = IRQ_TYPE_EDGE_FALLING; in __bcm2835_gpio_irq_set_type_enabled()
579 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
580 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
581 } else if (pc->irq_type[offset] == IRQ_TYPE_EDGE_FALLING) { in __bcm2835_gpio_irq_set_type_enabled()
583 pc->irq_type[offset] = IRQ_TYPE_EDGE_RISING; in __bcm2835_gpio_irq_set_type_enabled()
584 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
585 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
586 } else if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
587 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
588 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
589 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
595 if (pc->irq_type[offset] != type) { in __bcm2835_gpio_irq_set_type_enabled()
596 bcm2835_gpio_irq_config(pc, offset, false); in __bcm2835_gpio_irq_set_type_enabled()
597 pc->irq_type[offset] = type; in __bcm2835_gpio_irq_set_type_enabled()
598 bcm2835_gpio_irq_config(pc, offset, true); in __bcm2835_gpio_irq_set_type_enabled()
611 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_set_type() local
618 raw_spin_lock_irqsave(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_set_type()
620 if (test_bit(offset, &pc->enabled_irq_map[bank])) in bcm2835_gpio_irq_set_type()
621 ret = __bcm2835_gpio_irq_set_type_enabled(pc, gpio, type); in bcm2835_gpio_irq_set_type()
623 ret = __bcm2835_gpio_irq_set_type_disabled(pc, gpio, type); in bcm2835_gpio_irq_set_type()
630 raw_spin_unlock_irqrestore(&pc->irq_lock[bank], flags); in bcm2835_gpio_irq_set_type()
638 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_ack() local
641 bcm2835_gpio_set_bit(pc, GPEDS0, gpio); in bcm2835_gpio_irq_ack()
647 struct bcm2835_pinctrl *pc = gpiochip_get_data(chip); in bcm2835_gpio_irq_set_wake() local
652 if (!pc->wake_irq) in bcm2835_gpio_irq_set_wake()
665 ret = enable_irq_wake(pc->wake_irq[irqgroup]); in bcm2835_gpio_irq_set_wake()
667 ret = disable_irq_wake(pc->wake_irq[irqgroup]); in bcm2835_gpio_irq_set_wake()
710 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pctl_pin_dbg_show() local
711 struct gpio_chip *chip = &pc->gpio_chip; in bcm2835_pctl_pin_dbg_show()
712 enum bcm2835_fsel fsel = bcm2835_pinctrl_fsel_get(pc, offset); in bcm2835_pctl_pin_dbg_show()
714 int value = bcm2835_gpio_get_bit(pc, GPLEV0, offset); in bcm2835_pctl_pin_dbg_show()
719 irq, irq_type_names[pc->irq_type[offset]]); in bcm2835_pctl_pin_dbg_show()
734 static int bcm2835_pctl_dt_node_to_map_func(struct bcm2835_pinctrl *pc, in bcm2835_pctl_dt_node_to_map_func() argument
741 dev_err(pc->dev, "%pOF: invalid brcm,function %d\n", np, fnum); in bcm2835_pctl_dt_node_to_map_func()
753 static int bcm2835_pctl_dt_node_to_map_pull(struct bcm2835_pinctrl *pc, in bcm2835_pctl_dt_node_to_map_pull() argument
761 dev_err(pc->dev, "%pOF: invalid brcm,pull %d\n", np, pull); in bcm2835_pctl_dt_node_to_map_pull()
783 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pctl_dt_node_to_map() local
798 dev_err(pc->dev, "%pOF: missing brcm,pins property\n", np); in bcm2835_pctl_dt_node_to_map()
806 dev_err(pc->dev, in bcm2835_pctl_dt_node_to_map()
817 dev_err(pc->dev, in bcm2835_pctl_dt_node_to_map()
824 dev_err(pc->dev, in bcm2835_pctl_dt_node_to_map()
844 if (pin >= pc->pctl_desc.npins) { in bcm2835_pctl_dt_node_to_map()
845 dev_err(pc->dev, "%pOF: invalid brcm,pins value %d\n", in bcm2835_pctl_dt_node_to_map()
856 err = bcm2835_pctl_dt_node_to_map_func(pc, np, pin, in bcm2835_pctl_dt_node_to_map()
866 err = bcm2835_pctl_dt_node_to_map_pull(pc, np, pin, in bcm2835_pctl_dt_node_to_map()
895 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_free() local
898 bcm2835_pinctrl_fsel_set(pc, offset, BCM2835_FSEL_GPIO_IN); in bcm2835_pmx_free()
929 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_set() local
931 bcm2835_pinctrl_fsel_set(pc, group_selector, func_selector); in bcm2835_pmx_set()
940 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_gpio_disable_free() local
943 bcm2835_pinctrl_fsel_set(pc, offset, BCM2835_FSEL_GPIO_IN); in bcm2835_pmx_gpio_disable_free()
951 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pmx_gpio_set_direction() local
955 bcm2835_pinctrl_fsel_set(pc, offset, fsel); in bcm2835_pmx_gpio_set_direction()
977 static void bcm2835_pull_config_set(struct bcm2835_pinctrl *pc, in bcm2835_pull_config_set() argument
985 bcm2835_gpio_wr(pc, GPPUD, arg & 3); in bcm2835_pull_config_set()
993 bcm2835_gpio_wr(pc, GPPUDCLK0 + (off * 4), BIT(bit)); in bcm2835_pull_config_set()
995 bcm2835_gpio_wr(pc, GPPUDCLK0 + (off * 4), 0); in bcm2835_pull_config_set()
1002 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2835_pinconf_set() local
1013 bcm2835_pull_config_set(pc, pin, arg); in bcm2835_pinconf_set()
1018 bcm2835_pull_config_set(pc, pin, BCM2835_PUD_OFF); in bcm2835_pinconf_set()
1022 bcm2835_pull_config_set(pc, pin, BCM2835_PUD_DOWN); in bcm2835_pinconf_set()
1026 bcm2835_pull_config_set(pc, pin, BCM2835_PUD_UP); in bcm2835_pinconf_set()
1031 bcm2835_gpio_set_bit(pc, arg ? GPSET0 : GPCLR0, pin); in bcm2835_pinconf_set()
1049 static void bcm2711_pull_config_set(struct bcm2835_pinctrl *pc, in bcm2711_pull_config_set() argument
1059 value = bcm2835_gpio_rd(pc, GP_GPIO_PUP_PDN_CNTRL_REG0 + (off * 4)); in bcm2711_pull_config_set()
1062 bcm2835_gpio_wr(pc, GP_GPIO_PUP_PDN_CNTRL_REG0 + (off * 4), value); in bcm2711_pull_config_set()
1069 struct bcm2835_pinctrl *pc = pinctrl_dev_get_drvdata(pctldev); in bcm2711_pinconf_set() local
1087 bcm2711_pull_config_set(pc, pin, arg); in bcm2711_pinconf_set()
1092 bcm2711_pull_config_set(pc, pin, BCM2711_PULL_NONE); in bcm2711_pinconf_set()
1095 bcm2711_pull_config_set(pc, pin, BCM2711_PULL_DOWN); in bcm2711_pinconf_set()
1098 bcm2711_pull_config_set(pc, pin, BCM2711_PULL_UP); in bcm2711_pinconf_set()
1103 bcm2835_gpio_set_bit(pc, arg ? GPSET0 : GPCLR0, pin); in bcm2711_pinconf_set()
1189 struct bcm2835_pinctrl *pc; in bcm2835_pinctrl_probe() local
1199 pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL); in bcm2835_pinctrl_probe()
1200 if (!pc) in bcm2835_pinctrl_probe()
1203 platform_set_drvdata(pdev, pc); in bcm2835_pinctrl_probe()
1204 pc->dev = dev; in bcm2835_pinctrl_probe()
1212 pc->base = devm_ioremap_resource(dev, &iomem); in bcm2835_pinctrl_probe()
1213 if (IS_ERR(pc->base)) in bcm2835_pinctrl_probe()
1214 return PTR_ERR(pc->base); in bcm2835_pinctrl_probe()
1223 pc->gpio_chip = *pdata->gpio_chip; in bcm2835_pinctrl_probe()
1224 pc->gpio_chip.parent = dev; in bcm2835_pinctrl_probe()
1225 pc->gpio_chip.of_node = np; in bcm2835_pinctrl_probe()
1232 bcm2835_gpio_wr(pc, GPREN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1233 bcm2835_gpio_wr(pc, GPFEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1234 bcm2835_gpio_wr(pc, GPHEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1235 bcm2835_gpio_wr(pc, GPLEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1236 bcm2835_gpio_wr(pc, GPAREN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1237 bcm2835_gpio_wr(pc, GPAFEN0 + i * 4, 0); in bcm2835_pinctrl_probe()
1240 events = bcm2835_gpio_rd(pc, GPEDS0 + i * 4); in bcm2835_pinctrl_probe()
1242 bcm2835_gpio_wr(pc, GPEDS0 + i * 4, BIT(offset)); in bcm2835_pinctrl_probe()
1244 raw_spin_lock_init(&pc->irq_lock[i]); in bcm2835_pinctrl_probe()
1247 girq = &pc->gpio_chip.irq; in bcm2835_pinctrl_probe()
1258 pc->wake_irq = devm_kcalloc(dev, BCM2835_NUM_IRQS, in bcm2835_pinctrl_probe()
1259 sizeof(*pc->wake_irq), in bcm2835_pinctrl_probe()
1261 if (!pc->wake_irq) in bcm2835_pinctrl_probe()
1281 pc->wake_irq[i] = irq_of_parse_and_map(np, i + in bcm2835_pinctrl_probe()
1284 len = strlen(dev_name(pc->dev)) + 16; in bcm2835_pinctrl_probe()
1285 name = devm_kzalloc(pc->dev, len, GFP_KERNEL); in bcm2835_pinctrl_probe()
1289 snprintf(name, len, "%s:bank%d", dev_name(pc->dev), i); in bcm2835_pinctrl_probe()
1292 err = devm_request_irq(dev, pc->wake_irq[i], in bcm2835_pinctrl_probe()
1294 IRQF_SHARED, name, pc); in bcm2835_pinctrl_probe()
1297 pc->wake_irq[i]); in bcm2835_pinctrl_probe()
1303 err = gpiochip_add_data(&pc->gpio_chip, pc); in bcm2835_pinctrl_probe()
1309 pc->pctl_desc = *pdata->pctl_desc; in bcm2835_pinctrl_probe()
1310 pc->pctl_dev = devm_pinctrl_register(dev, &pc->pctl_desc, pc); in bcm2835_pinctrl_probe()
1311 if (IS_ERR(pc->pctl_dev)) { in bcm2835_pinctrl_probe()
1312 gpiochip_remove(&pc->gpio_chip); in bcm2835_pinctrl_probe()
1313 return PTR_ERR(pc->pctl_dev); in bcm2835_pinctrl_probe()
1316 pc->gpio_range = *pdata->gpio_range; in bcm2835_pinctrl_probe()
1317 pc->gpio_range.base = pc->gpio_chip.base; in bcm2835_pinctrl_probe()
1318 pc->gpio_range.gc = &pc->gpio_chip; in bcm2835_pinctrl_probe()
1319 pinctrl_add_gpio_range(pc->pctl_dev, &pc->gpio_range); in bcm2835_pinctrl_probe()