Lines Matching +full:pio +full:- +full:mode
1 // SPDX-License-Identifier: GPL-2.0-only
5 * Copyright (C) 2011-2012 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
29 #include "pinctrl-at91.h"
42 * @pioc_hwirq: PIO bank interrupt identifier on AIC
43 * @pioc_virq: PIO bank Linux virtual interrupt
44 * @regbase: PIO bank virtual address
114 * struct at91_pmx_func - describes AT91 pinmux functions
134 * struct at91_pmx_pin - describes an At91 pin mux
137 * @mux: the mux mode : gpio or periph_x of the pin i.e. alternate function.
148 * struct at91_pin_group - describes an At91 pin group
150 * @pins_conf: the mux mode for each pin in this group. The size of this
153 * from the driver-local pin enumeration space
165 * struct at91_pinctrl_mux_ops - describes an AT91 mux ops group
170 * @get_periph: return the periph mode configured
190 enum at91_mux (*get_periph)(void __iomem *pio, unsigned mask);
191 void (*mux_A_periph)(void __iomem *pio, unsigned mask);
192 void (*mux_B_periph)(void __iomem *pio, unsigned mask);
193 void (*mux_C_periph)(void __iomem *pio, unsigned mask);
194 void (*mux_D_periph)(void __iomem *pio, unsigned mask);
195 bool (*get_deglitch)(void __iomem *pio, unsigned pin);
196 void (*set_deglitch)(void __iomem *pio, unsigned mask, bool is_on);
197 bool (*get_debounce)(void __iomem *pio, unsigned pin, u32 *div);
198 void (*set_debounce)(void __iomem *pio, unsigned mask, bool is_on, u32 div);
199 bool (*get_pulldown)(void __iomem *pio, unsigned pin);
200 void (*set_pulldown)(void __iomem *pio, unsigned mask, bool is_on);
201 bool (*get_schmitt_trig)(void __iomem *pio, unsigned pin);
202 void (*disable_schmitt_trig)(void __iomem *pio, unsigned mask);
203 unsigned (*get_drivestrength)(void __iomem *pio, unsigned pin);
204 void (*set_drivestrength)(void __iomem *pio, unsigned pin,
206 unsigned (*get_slewrate)(void __iomem *pio, unsigned pin);
207 void (*set_slewrate)(void __iomem *pio, unsigned pin, u32 slewrate);
240 for (i = 0; i < info->ngroups; i++) { in at91_pinctrl_find_group_by_name()
241 if (strcmp(info->groups[i].name, name)) in at91_pinctrl_find_group_by_name()
244 grp = &info->groups[i]; in at91_pinctrl_find_group_by_name()
245 dev_dbg(info->dev, "%s: %d 0:%d\n", name, grp->npins, grp->pins[0]); in at91_pinctrl_find_group_by_name()
256 return info->ngroups; in at91_get_groups_count()
264 return info->groups[selector].name; in at91_get_group_name()
273 if (selector >= info->ngroups) in at91_get_group_pins()
274 return -EINVAL; in at91_get_group_pins()
276 *pins = info->groups[selector].pins; in at91_get_group_pins()
277 *npins = info->groups[selector].npins; in at91_get_group_pins()
285 seq_printf(s, "%s", dev_name(pctldev->dev)); in at91_pin_dbg_show()
303 grp = at91_pinctrl_find_group_by_name(info, np->name); in at91_dt_node_to_map()
305 dev_err(info->dev, "unable to find group for node %pOFn\n", in at91_dt_node_to_map()
307 return -EINVAL; in at91_dt_node_to_map()
310 map_num += grp->npins; in at91_dt_node_to_map()
311 new_map = devm_kcalloc(pctldev->dev, map_num, sizeof(*new_map), in at91_dt_node_to_map()
314 return -ENOMEM; in at91_dt_node_to_map()
322 devm_kfree(pctldev->dev, new_map); in at91_dt_node_to_map()
323 return -EINVAL; in at91_dt_node_to_map()
326 new_map[0].data.mux.function = parent->name; in at91_dt_node_to_map()
327 new_map[0].data.mux.group = np->name; in at91_dt_node_to_map()
332 for (i = 0; i < grp->npins; i++) { in at91_dt_node_to_map()
335 pin_get_name(pctldev, grp->pins[i]); in at91_dt_node_to_map()
336 new_map[i].data.configs.configs = &grp->pins_conf[i].conf; in at91_dt_node_to_map()
340 dev_dbg(pctldev->dev, "maps: function %s group %s num %d\n", in at91_dt_node_to_map()
341 (*map)->data.mux.function, (*map)->data.mux.group, map_num); in at91_dt_node_to_map()
366 return gpio_chips[bank]->regbase; in pin_to_controller()
384 ? pin - MAX_NB_GPIO_PER_BANK/2 : pin); in two_bit_pin_value_shift_amount()
403 static void at91_mux_disable_interrupt(void __iomem *pio, unsigned mask) in at91_mux_disable_interrupt() argument
405 writel_relaxed(mask, pio + PIO_IDR); in at91_mux_disable_interrupt()
408 static unsigned at91_mux_get_pullup(void __iomem *pio, unsigned pin) in at91_mux_get_pullup() argument
410 return !((readl_relaxed(pio + PIO_PUSR) >> pin) & 0x1); in at91_mux_get_pullup()
413 static void at91_mux_set_pullup(void __iomem *pio, unsigned mask, bool on) in at91_mux_set_pullup() argument
416 writel_relaxed(mask, pio + PIO_PPDDR); in at91_mux_set_pullup()
418 writel_relaxed(mask, pio + (on ? PIO_PUER : PIO_PUDR)); in at91_mux_set_pullup()
421 static bool at91_mux_get_output(void __iomem *pio, unsigned int pin, bool *val) in at91_mux_get_output() argument
423 *val = (readl_relaxed(pio + PIO_ODSR) >> pin) & 0x1; in at91_mux_get_output()
424 return (readl_relaxed(pio + PIO_OSR) >> pin) & 0x1; in at91_mux_get_output()
427 static void at91_mux_set_output(void __iomem *pio, unsigned int mask, in at91_mux_set_output() argument
430 writel_relaxed(mask, pio + (val ? PIO_SODR : PIO_CODR)); in at91_mux_set_output()
431 writel_relaxed(mask, pio + (is_on ? PIO_OER : PIO_ODR)); in at91_mux_set_output()
434 static unsigned at91_mux_get_multidrive(void __iomem *pio, unsigned pin) in at91_mux_get_multidrive() argument
436 return (readl_relaxed(pio + PIO_MDSR) >> pin) & 0x1; in at91_mux_get_multidrive()
439 static void at91_mux_set_multidrive(void __iomem *pio, unsigned mask, bool on) in at91_mux_set_multidrive() argument
441 writel_relaxed(mask, pio + (on ? PIO_MDER : PIO_MDDR)); in at91_mux_set_multidrive()
444 static void at91_mux_set_A_periph(void __iomem *pio, unsigned mask) in at91_mux_set_A_periph() argument
446 writel_relaxed(mask, pio + PIO_ASR); in at91_mux_set_A_periph()
449 static void at91_mux_set_B_periph(void __iomem *pio, unsigned mask) in at91_mux_set_B_periph() argument
451 writel_relaxed(mask, pio + PIO_BSR); in at91_mux_set_B_periph()
454 static void at91_mux_pio3_set_A_periph(void __iomem *pio, unsigned mask) in at91_mux_pio3_set_A_periph() argument
457 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR1) & ~mask, in at91_mux_pio3_set_A_periph()
458 pio + PIO_ABCDSR1); in at91_mux_pio3_set_A_periph()
459 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR2) & ~mask, in at91_mux_pio3_set_A_periph()
460 pio + PIO_ABCDSR2); in at91_mux_pio3_set_A_periph()
463 static void at91_mux_pio3_set_B_periph(void __iomem *pio, unsigned mask) in at91_mux_pio3_set_B_periph() argument
465 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR1) | mask, in at91_mux_pio3_set_B_periph()
466 pio + PIO_ABCDSR1); in at91_mux_pio3_set_B_periph()
467 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR2) & ~mask, in at91_mux_pio3_set_B_periph()
468 pio + PIO_ABCDSR2); in at91_mux_pio3_set_B_periph()
471 static void at91_mux_pio3_set_C_periph(void __iomem *pio, unsigned mask) in at91_mux_pio3_set_C_periph() argument
473 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR1) & ~mask, pio + PIO_ABCDSR1); in at91_mux_pio3_set_C_periph()
474 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR2) | mask, pio + PIO_ABCDSR2); in at91_mux_pio3_set_C_periph()
477 static void at91_mux_pio3_set_D_periph(void __iomem *pio, unsigned mask) in at91_mux_pio3_set_D_periph() argument
479 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR1) | mask, pio + PIO_ABCDSR1); in at91_mux_pio3_set_D_periph()
480 writel_relaxed(readl_relaxed(pio + PIO_ABCDSR2) | mask, pio + PIO_ABCDSR2); in at91_mux_pio3_set_D_periph()
483 static enum at91_mux at91_mux_pio3_get_periph(void __iomem *pio, unsigned mask) in at91_mux_pio3_get_periph() argument
487 if (readl_relaxed(pio + PIO_PSR) & mask) in at91_mux_pio3_get_periph()
490 select = !!(readl_relaxed(pio + PIO_ABCDSR1) & mask); in at91_mux_pio3_get_periph()
491 select |= (!!(readl_relaxed(pio + PIO_ABCDSR2) & mask) << 1); in at91_mux_pio3_get_periph()
496 static enum at91_mux at91_mux_get_periph(void __iomem *pio, unsigned mask) in at91_mux_get_periph() argument
500 if (readl_relaxed(pio + PIO_PSR) & mask) in at91_mux_get_periph()
503 select = readl_relaxed(pio + PIO_ABSR) & mask; in at91_mux_get_periph()
508 static bool at91_mux_get_deglitch(void __iomem *pio, unsigned pin) in at91_mux_get_deglitch() argument
510 return (readl_relaxed(pio + PIO_IFSR) >> pin) & 0x1; in at91_mux_get_deglitch()
513 static void at91_mux_set_deglitch(void __iomem *pio, unsigned mask, bool is_on) in at91_mux_set_deglitch() argument
515 writel_relaxed(mask, pio + (is_on ? PIO_IFER : PIO_IFDR)); in at91_mux_set_deglitch()
518 static bool at91_mux_pio3_get_deglitch(void __iomem *pio, unsigned pin) in at91_mux_pio3_get_deglitch() argument
520 if ((readl_relaxed(pio + PIO_IFSR) >> pin) & 0x1) in at91_mux_pio3_get_deglitch()
521 return !((readl_relaxed(pio + PIO_IFSCSR) >> pin) & 0x1); in at91_mux_pio3_get_deglitch()
526 static void at91_mux_pio3_set_deglitch(void __iomem *pio, unsigned mask, bool is_on) in at91_mux_pio3_set_deglitch() argument
529 writel_relaxed(mask, pio + PIO_IFSCDR); in at91_mux_pio3_set_deglitch()
530 at91_mux_set_deglitch(pio, mask, is_on); in at91_mux_pio3_set_deglitch()
533 static bool at91_mux_pio3_get_debounce(void __iomem *pio, unsigned pin, u32 *div) in at91_mux_pio3_get_debounce() argument
535 *div = readl_relaxed(pio + PIO_SCDR); in at91_mux_pio3_get_debounce()
537 return ((readl_relaxed(pio + PIO_IFSR) >> pin) & 0x1) && in at91_mux_pio3_get_debounce()
538 ((readl_relaxed(pio + PIO_IFSCSR) >> pin) & 0x1); in at91_mux_pio3_get_debounce()
541 static void at91_mux_pio3_set_debounce(void __iomem *pio, unsigned mask, in at91_mux_pio3_set_debounce() argument
545 writel_relaxed(mask, pio + PIO_IFSCER); in at91_mux_pio3_set_debounce()
546 writel_relaxed(div & PIO_SCDR_DIV, pio + PIO_SCDR); in at91_mux_pio3_set_debounce()
547 writel_relaxed(mask, pio + PIO_IFER); in at91_mux_pio3_set_debounce()
549 writel_relaxed(mask, pio + PIO_IFSCDR); in at91_mux_pio3_set_debounce()
552 static bool at91_mux_pio3_get_pulldown(void __iomem *pio, unsigned pin) in at91_mux_pio3_get_pulldown() argument
554 return !((readl_relaxed(pio + PIO_PPDSR) >> pin) & 0x1); in at91_mux_pio3_get_pulldown()
557 static void at91_mux_pio3_set_pulldown(void __iomem *pio, unsigned mask, bool is_on) in at91_mux_pio3_set_pulldown() argument
560 writel_relaxed(mask, pio + PIO_PUDR); in at91_mux_pio3_set_pulldown()
562 writel_relaxed(mask, pio + (is_on ? PIO_PPDER : PIO_PPDDR)); in at91_mux_pio3_set_pulldown()
565 static void at91_mux_pio3_disable_schmitt_trig(void __iomem *pio, unsigned mask) in at91_mux_pio3_disable_schmitt_trig() argument
567 writel_relaxed(readl_relaxed(pio + PIO_SCHMITT) | mask, pio + PIO_SCHMITT); in at91_mux_pio3_disable_schmitt_trig()
570 static bool at91_mux_pio3_get_schmitt_trig(void __iomem *pio, unsigned pin) in at91_mux_pio3_get_schmitt_trig() argument
572 return (readl_relaxed(pio + PIO_SCHMITT) >> pin) & 0x1; in at91_mux_pio3_get_schmitt_trig()
584 static unsigned at91_mux_sama5d3_get_drivestrength(void __iomem *pio, in at91_mux_sama5d3_get_drivestrength() argument
587 unsigned tmp = read_drive_strength(pio + in at91_mux_sama5d3_get_drivestrength()
598 static unsigned at91_mux_sam9x5_get_drivestrength(void __iomem *pio, in at91_mux_sam9x5_get_drivestrength() argument
601 unsigned tmp = read_drive_strength(pio + in at91_mux_sam9x5_get_drivestrength()
606 tmp = DRIVE_STRENGTH_BIT_MSK(HI) - tmp; in at91_mux_sam9x5_get_drivestrength()
611 static unsigned at91_mux_sam9x60_get_drivestrength(void __iomem *pio, in at91_mux_sam9x60_get_drivestrength() argument
614 unsigned tmp = readl_relaxed(pio + SAM9X60_PIO_DRIVER1); in at91_mux_sam9x60_get_drivestrength()
622 static unsigned at91_mux_sam9x60_get_slewrate(void __iomem *pio, unsigned pin) in at91_mux_sam9x60_get_slewrate() argument
624 unsigned tmp = readl_relaxed(pio + SAM9X60_PIO_SLEWR); in at91_mux_sam9x60_get_slewrate()
643 static void at91_mux_sama5d3_set_drivestrength(void __iomem *pio, unsigned pin, in at91_mux_sama5d3_set_drivestrength() argument
651 set_drive_strength(pio + sama5d3_get_drive_register(pin), pin, setting); in at91_mux_sama5d3_set_drivestrength()
654 static void at91_mux_sam9x5_set_drivestrength(void __iomem *pio, unsigned pin, in at91_mux_sam9x5_set_drivestrength() argument
663 setting = DRIVE_STRENGTH_BIT_MSK(HI) - setting; in at91_mux_sam9x5_set_drivestrength()
665 set_drive_strength(pio + at91sam9x5_get_drive_register(pin), pin, in at91_mux_sam9x5_set_drivestrength()
669 static void at91_mux_sam9x60_set_drivestrength(void __iomem *pio, unsigned pin, in at91_mux_sam9x60_set_drivestrength() argument
679 tmp = readl_relaxed(pio + SAM9X60_PIO_DRIVER1); in at91_mux_sam9x60_set_drivestrength()
687 writel_relaxed(tmp, pio + SAM9X60_PIO_DRIVER1); in at91_mux_sam9x60_set_drivestrength()
690 static void at91_mux_sam9x60_set_slewrate(void __iomem *pio, unsigned pin, in at91_mux_sam9x60_set_slewrate() argument
698 tmp = readl_relaxed(pio + SAM9X60_PIO_SLEWR); in at91_mux_sam9x60_set_slewrate()
705 writel_relaxed(tmp, pio + SAM9X60_PIO_SLEWR); in at91_mux_sam9x60_set_slewrate()
778 if (pin->mux) { in at91_pin_dbg()
779 dev_dbg(dev, "pio%c%d configured as periph%c with conf = 0x%lx\n", in at91_pin_dbg()
780 pin->bank + 'A', pin->pin, pin->mux - 1 + 'A', pin->conf); in at91_pin_dbg()
782 dev_dbg(dev, "pio%c%d configured as gpio with conf = 0x%lx\n", in at91_pin_dbg()
783 pin->bank + 'A', pin->pin, pin->conf); in at91_pin_dbg()
793 if (pin->bank >= gpio_banks) { in pin_check_config()
794 dev_err(info->dev, "%s: pin conf %d bank_id %d >= nbanks %d\n", in pin_check_config()
795 name, index, pin->bank, gpio_banks); in pin_check_config()
796 return -EINVAL; in pin_check_config()
799 if (!gpio_chips[pin->bank]) { in pin_check_config()
800 dev_err(info->dev, "%s: pin conf %d bank_id %d not enabled\n", in pin_check_config()
801 name, index, pin->bank); in pin_check_config()
802 return -ENXIO; in pin_check_config()
805 if (pin->pin >= MAX_NB_GPIO_PER_BANK) { in pin_check_config()
806 dev_err(info->dev, "%s: pin conf %d pin_bank_id %d >= %d\n", in pin_check_config()
807 name, index, pin->pin, MAX_NB_GPIO_PER_BANK); in pin_check_config()
808 return -EINVAL; in pin_check_config()
811 if (!pin->mux) in pin_check_config()
814 mux = pin->mux - 1; in pin_check_config()
816 if (mux >= info->nmux) { in pin_check_config()
817 dev_err(info->dev, "%s: pin conf %d mux_id %d >= nmux %d\n", in pin_check_config()
818 name, index, mux, info->nmux); in pin_check_config()
819 return -EINVAL; in pin_check_config()
822 if (!(info->mux_mask[pin->bank * info->nmux + mux] & 1 << pin->pin)) { in pin_check_config()
823 dev_err(info->dev, "%s: pin conf %d mux_id %d not supported for pio%c%d\n", in pin_check_config()
824 name, index, mux, pin->bank + 'A', pin->pin); in pin_check_config()
825 return -EINVAL; in pin_check_config()
831 static void at91_mux_gpio_disable(void __iomem *pio, unsigned mask) in at91_mux_gpio_disable() argument
833 writel_relaxed(mask, pio + PIO_PDR); in at91_mux_gpio_disable()
836 static void at91_mux_gpio_enable(void __iomem *pio, unsigned mask, bool input) in at91_mux_gpio_enable() argument
838 writel_relaxed(mask, pio + PIO_PER); in at91_mux_gpio_enable()
839 writel_relaxed(mask, pio + (input ? PIO_ODR : PIO_OER)); in at91_mux_gpio_enable()
846 const struct at91_pmx_pin *pins_conf = info->groups[group].pins_conf; in at91_pmx_set()
848 uint32_t npins = info->groups[group].npins; in at91_pmx_set()
851 void __iomem *pio; in at91_pmx_set() local
853 dev_dbg(info->dev, "enable function %s group %s\n", in at91_pmx_set()
854 info->functions[selector].name, info->groups[group].name); in at91_pmx_set()
860 ret = pin_check_config(info, info->groups[group].name, i, pin); in at91_pmx_set()
867 at91_pin_dbg(info->dev, pin); in at91_pmx_set()
868 pio = pin_to_controller(info, pin->bank); in at91_pmx_set()
870 if (!pio) in at91_pmx_set()
873 mask = pin_to_mask(pin->pin); in at91_pmx_set()
874 at91_mux_disable_interrupt(pio, mask); in at91_pmx_set()
875 switch (pin->mux) { in at91_pmx_set()
877 at91_mux_gpio_enable(pio, mask, 1); in at91_pmx_set()
880 info->ops->mux_A_periph(pio, mask); in at91_pmx_set()
883 info->ops->mux_B_periph(pio, mask); in at91_pmx_set()
886 if (!info->ops->mux_C_periph) in at91_pmx_set()
887 return -EINVAL; in at91_pmx_set()
888 info->ops->mux_C_periph(pio, mask); in at91_pmx_set()
891 if (!info->ops->mux_D_periph) in at91_pmx_set()
892 return -EINVAL; in at91_pmx_set()
893 info->ops->mux_D_periph(pio, mask); in at91_pmx_set()
896 if (pin->mux) in at91_pmx_set()
897 at91_mux_gpio_disable(pio, mask); in at91_pmx_set()
907 return info->nfunctions; in at91_pmx_get_funcs_count()
915 return info->functions[selector].name; in at91_pmx_get_func_name()
924 *groups = info->functions[selector].groups; in at91_pmx_get_groups()
925 *num_groups = info->functions[selector].ngroups; in at91_pmx_get_groups()
940 dev_err(npct->dev, "invalid range\n"); in at91_gpio_request_enable()
941 return -EINVAL; in at91_gpio_request_enable()
943 if (!range->gc) { in at91_gpio_request_enable()
944 dev_err(npct->dev, "missing GPIO chip in range\n"); in at91_gpio_request_enable()
945 return -EINVAL; in at91_gpio_request_enable()
947 chip = range->gc; in at91_gpio_request_enable()
950 dev_dbg(npct->dev, "enable pin %u as GPIO\n", offset); in at91_gpio_request_enable()
952 mask = 1 << (offset - chip->base); in at91_gpio_request_enable()
954 dev_dbg(npct->dev, "enable pin %u as PIO%c%d 0x%x\n", in at91_gpio_request_enable()
955 offset, 'A' + range->id, offset - chip->base, mask); in at91_gpio_request_enable()
957 writel_relaxed(mask, at91_chip->regbase + PIO_PER); in at91_gpio_request_enable()
968 dev_dbg(npct->dev, "disable pin %u as GPIO\n", offset); in at91_gpio_disable_free()
985 void __iomem *pio; in at91_pinconf_get() local
991 dev_dbg(info->dev, "%s:%d, pin_id=%d", __func__, __LINE__, pin_id); in at91_pinconf_get()
992 pio = pin_to_controller(info, pin_to_bank(pin_id)); in at91_pinconf_get()
994 if (!pio) in at91_pinconf_get()
995 return -EINVAL; in at91_pinconf_get()
999 if (at91_mux_get_multidrive(pio, pin)) in at91_pinconf_get()
1002 if (at91_mux_get_pullup(pio, pin)) in at91_pinconf_get()
1005 if (info->ops->get_deglitch && info->ops->get_deglitch(pio, pin)) in at91_pinconf_get()
1007 if (info->ops->get_debounce && info->ops->get_debounce(pio, pin, &div)) in at91_pinconf_get()
1009 if (info->ops->get_pulldown && info->ops->get_pulldown(pio, pin)) in at91_pinconf_get()
1011 if (info->ops->get_schmitt_trig && info->ops->get_schmitt_trig(pio, pin)) in at91_pinconf_get()
1013 if (info->ops->get_drivestrength) in at91_pinconf_get()
1014 *config |= (info->ops->get_drivestrength(pio, pin) in at91_pinconf_get()
1016 if (info->ops->get_slewrate) in at91_pinconf_get()
1017 *config |= (info->ops->get_slewrate(pio, pin) << SLEWRATE_SHIFT); in at91_pinconf_get()
1018 if (at91_mux_get_output(pio, pin, &out)) in at91_pinconf_get()
1030 void __iomem *pio; in at91_pinconf_set() local
1038 dev_dbg(info->dev, in at91_pinconf_set()
1041 pio = pin_to_controller(info, pin_to_bank(pin_id)); in at91_pinconf_set()
1043 if (!pio) in at91_pinconf_set()
1044 return -EINVAL; in at91_pinconf_set()
1050 return -EINVAL; in at91_pinconf_set()
1052 at91_mux_set_output(pio, mask, config & OUTPUT, in at91_pinconf_set()
1054 at91_mux_set_pullup(pio, mask, config & PULL_UP); in at91_pinconf_set()
1055 at91_mux_set_multidrive(pio, mask, config & MULTI_DRIVE); in at91_pinconf_set()
1056 if (info->ops->set_deglitch) in at91_pinconf_set()
1057 info->ops->set_deglitch(pio, mask, config & DEGLITCH); in at91_pinconf_set()
1058 if (info->ops->set_debounce) in at91_pinconf_set()
1059 info->ops->set_debounce(pio, mask, config & DEBOUNCE, in at91_pinconf_set()
1061 if (info->ops->set_pulldown) in at91_pinconf_set()
1062 info->ops->set_pulldown(pio, mask, config & PULL_DOWN); in at91_pinconf_set()
1063 if (info->ops->disable_schmitt_trig && config & DIS_SCHMIT) in at91_pinconf_set()
1064 info->ops->disable_schmitt_trig(pio, mask); in at91_pinconf_set()
1065 if (info->ops->set_drivestrength) in at91_pinconf_set()
1066 info->ops->set_drivestrength(pio, pin, in at91_pinconf_set()
1069 if (info->ops->set_slewrate) in at91_pinconf_set()
1070 info->ops->set_slewrate(pio, pin, in at91_pinconf_set()
1144 static const char *gpio_compat = "atmel,at91rm9200-gpio";
1154 info->nactive_banks++; in at91_pinctrl_child_count()
1156 info->nfunctions++; in at91_pinctrl_child_count()
1157 info->ngroups += of_get_child_count(child); in at91_pinctrl_child_count()
1169 list = of_get_property(np, "atmel,mux-mask", &size); in at91_pinctrl_mux_mask()
1171 dev_err(info->dev, "can not read the mux-mask of %d\n", size); in at91_pinctrl_mux_mask()
1172 return -EINVAL; in at91_pinctrl_mux_mask()
1177 dev_err(info->dev, "wrong mux mask array should be by %d\n", gpio_banks); in at91_pinctrl_mux_mask()
1178 return -EINVAL; in at91_pinctrl_mux_mask()
1180 info->nmux = size / gpio_banks; in at91_pinctrl_mux_mask()
1182 info->mux_mask = devm_kcalloc(info->dev, size, sizeof(u32), in at91_pinctrl_mux_mask()
1184 if (!info->mux_mask) in at91_pinctrl_mux_mask()
1185 return -ENOMEM; in at91_pinctrl_mux_mask()
1187 ret = of_property_read_u32_array(np, "atmel,mux-mask", in at91_pinctrl_mux_mask()
1188 info->mux_mask, size); in at91_pinctrl_mux_mask()
1190 dev_err(info->dev, "can not read the mux-mask of %d\n", size); in at91_pinctrl_mux_mask()
1203 dev_dbg(info->dev, "group(%d): %pOFn\n", index, np); in at91_pinctrl_parse_groups()
1206 grp->name = np->name; in at91_pinctrl_parse_groups()
1216 dev_err(info->dev, "wrong pins number or pins and configs should be by 4\n"); in at91_pinctrl_parse_groups()
1217 return -EINVAL; in at91_pinctrl_parse_groups()
1220 grp->npins = size / 4; in at91_pinctrl_parse_groups()
1221 pin = grp->pins_conf = devm_kcalloc(info->dev, in at91_pinctrl_parse_groups()
1222 grp->npins, in at91_pinctrl_parse_groups()
1225 grp->pins = devm_kcalloc(info->dev, grp->npins, sizeof(unsigned int), in at91_pinctrl_parse_groups()
1227 if (!grp->pins_conf || !grp->pins) in at91_pinctrl_parse_groups()
1228 return -ENOMEM; in at91_pinctrl_parse_groups()
1231 pin->bank = be32_to_cpu(*list++); in at91_pinctrl_parse_groups()
1232 pin->pin = be32_to_cpu(*list++); in at91_pinctrl_parse_groups()
1233 grp->pins[j] = pin->bank * MAX_NB_GPIO_PER_BANK + pin->pin; in at91_pinctrl_parse_groups()
1234 pin->mux = be32_to_cpu(*list++); in at91_pinctrl_parse_groups()
1235 pin->conf = be32_to_cpu(*list++); in at91_pinctrl_parse_groups()
1237 at91_pin_dbg(info->dev, pin); in at91_pinctrl_parse_groups()
1254 dev_dbg(info->dev, "parse function(%d): %pOFn\n", index, np); in at91_pinctrl_parse_functions()
1256 func = &info->functions[index]; in at91_pinctrl_parse_functions()
1259 func->name = np->name; in at91_pinctrl_parse_functions()
1260 func->ngroups = of_get_child_count(np); in at91_pinctrl_parse_functions()
1261 if (func->ngroups == 0) { in at91_pinctrl_parse_functions()
1262 dev_err(info->dev, "no groups defined\n"); in at91_pinctrl_parse_functions()
1263 return -EINVAL; in at91_pinctrl_parse_functions()
1265 func->groups = devm_kcalloc(info->dev, in at91_pinctrl_parse_functions()
1266 func->ngroups, sizeof(char *), GFP_KERNEL); in at91_pinctrl_parse_functions()
1267 if (!func->groups) in at91_pinctrl_parse_functions()
1268 return -ENOMEM; in at91_pinctrl_parse_functions()
1271 func->groups[i] = child->name; in at91_pinctrl_parse_functions()
1272 grp = &info->groups[grp_index++]; in at91_pinctrl_parse_functions()
1284 { .compatible = "atmel,sama5d3-pinctrl", .data = &sama5d3_ops },
1285 { .compatible = "atmel,at91sam9x5-pinctrl", .data = &at91sam9x5_ops },
1286 { .compatible = "atmel,at91rm9200-pinctrl", .data = &at91rm9200_ops },
1287 { .compatible = "microchip,sam9x60-pinctrl", .data = &sam9x60_ops },
1294 struct device *dev = &pdev->dev; in at91_pinctrl_probe_dt()
1298 struct device_node *np = dev->of_node; in at91_pinctrl_probe_dt()
1302 return -ENODEV; in at91_pinctrl_probe_dt()
1304 info->dev = &pdev->dev; in at91_pinctrl_probe_dt()
1305 info->ops = device_get_match_data(&pdev->dev); in at91_pinctrl_probe_dt()
1317 if (ngpio_chips_enabled < info->nactive_banks) in at91_pinctrl_probe_dt()
1318 return -EPROBE_DEFER; in at91_pinctrl_probe_dt()
1324 dev_dbg(dev, "nmux = %d\n", info->nmux); in at91_pinctrl_probe_dt()
1326 dev_dbg(dev, "mux-mask\n"); in at91_pinctrl_probe_dt()
1327 tmp = info->mux_mask; in at91_pinctrl_probe_dt()
1329 for (j = 0; j < info->nmux; j++, tmp++) { in at91_pinctrl_probe_dt()
1334 dev_dbg(dev, "nfunctions = %d\n", info->nfunctions); in at91_pinctrl_probe_dt()
1335 dev_dbg(dev, "ngroups = %d\n", info->ngroups); in at91_pinctrl_probe_dt()
1336 info->functions = devm_kcalloc(dev, info->nfunctions, sizeof(*info->functions), in at91_pinctrl_probe_dt()
1338 if (!info->functions) in at91_pinctrl_probe_dt()
1339 return -ENOMEM; in at91_pinctrl_probe_dt()
1341 info->groups = devm_kcalloc(dev, info->ngroups, sizeof(*info->groups), in at91_pinctrl_probe_dt()
1343 if (!info->groups) in at91_pinctrl_probe_dt()
1344 return -ENOMEM; in at91_pinctrl_probe_dt()
1347 dev_dbg(dev, "nfunctions = %d\n", info->nfunctions); in at91_pinctrl_probe_dt()
1348 dev_dbg(dev, "ngroups = %d\n", info->ngroups); in at91_pinctrl_probe_dt()
1367 struct device *dev = &pdev->dev; in at91_pinctrl_probe()
1374 return -ENOMEM; in at91_pinctrl_probe()
1385 return -ENOMEM; in at91_pinctrl_probe()
1390 names = devm_kasprintf_strarray(dev, "pio", MAX_NB_GPIO_PER_BANK); in at91_pinctrl_probe()
1397 strreplace(name, '-', i + 'A'); in at91_pinctrl_probe()
1399 pdesc->number = k; in at91_pinctrl_probe()
1400 pdesc->name = name; in at91_pinctrl_probe()
1406 info->pctl = devm_pinctrl_register(dev, &at91_pinctrl_desc, info); in at91_pinctrl_probe()
1407 if (IS_ERR(info->pctl)) in at91_pinctrl_probe()
1408 return dev_err_probe(dev, PTR_ERR(info->pctl), "could not register AT91 pinctrl driver\n"); in at91_pinctrl_probe()
1413 pinctrl_add_gpio_range(info->pctl, &gpio_chips[i]->range); in at91_pinctrl_probe()
1414 gpiochip_add_pin_range(&gpio_chips[i]->chip, dev_name(info->pctl->dev), 0, in at91_pinctrl_probe()
1415 gpio_chips[i]->range.pin_base, gpio_chips[i]->range.npins); in at91_pinctrl_probe()
1426 void __iomem *pio = at91_gpio->regbase; in at91_gpio_get_direction() local
1430 osr = readl_relaxed(pio + PIO_OSR); in at91_gpio_get_direction()
1440 void __iomem *pio = at91_gpio->regbase; in at91_gpio_direction_input() local
1443 writel_relaxed(mask, pio + PIO_ODR); in at91_gpio_direction_input()
1450 void __iomem *pio = at91_gpio->regbase; in at91_gpio_get() local
1454 pdsr = readl_relaxed(pio + PIO_PDSR); in at91_gpio_get()
1462 void __iomem *pio = at91_gpio->regbase; in at91_gpio_set() local
1465 writel_relaxed(mask, pio + (val ? PIO_SODR : PIO_CODR)); in at91_gpio_set()
1472 void __iomem *pio = at91_gpio->regbase; in at91_gpio_set_multiple() local
1474 #define BITS_MASK(bits) (((bits) == 32) ? ~0U : (BIT(bits) - 1)) in at91_gpio_set_multiple()
1476 uint32_t set_mask = (*mask & *bits) & BITS_MASK(chip->ngpio); in at91_gpio_set_multiple()
1477 uint32_t clear_mask = (*mask & ~(*bits)) & BITS_MASK(chip->ngpio); in at91_gpio_set_multiple()
1479 writel_relaxed(set_mask, pio + PIO_SODR); in at91_gpio_set_multiple()
1480 writel_relaxed(clear_mask, pio + PIO_CODR); in at91_gpio_set_multiple()
1487 void __iomem *pio = at91_gpio->regbase; in at91_gpio_direction_output() local
1490 writel_relaxed(mask, pio + (val ? PIO_SODR : PIO_CODR)); in at91_gpio_direction_output()
1491 writel_relaxed(mask, pio + PIO_OER); in at91_gpio_direction_output()
1499 enum at91_mux mode; in at91_gpio_dbg_show() local
1502 void __iomem *pio = at91_gpio->regbase; in at91_gpio_dbg_show() local
1508 mode = at91_gpio->ops->get_periph(pio, mask); in at91_gpio_dbg_show()
1510 gpio_label, chip->label, i); in at91_gpio_dbg_show()
1511 if (mode == AT91_MUX_GPIO) { in at91_gpio_dbg_show()
1514 readl_relaxed(pio + PIO_OSR) & mask ? in at91_gpio_dbg_show()
1517 readl_relaxed(pio + PIO_PDSR) & mask ? in at91_gpio_dbg_show()
1521 mode + 'A' - 1); in at91_gpio_dbg_show()
1533 return gpiochip_lock_as_irq(&at91_gpio->chip, irqd_to_hwirq(d)); in gpio_irq_request_resources()
1540 gpiochip_unlock_as_irq(&at91_gpio->chip, irqd_to_hwirq(d)); in gpio_irq_release_resources()
1560 void __iomem *pio = at91_gpio->regbase; in gpio_irq_mask() local
1561 unsigned mask = 1 << d->hwirq; in gpio_irq_mask()
1564 gpiochip_disable_irq(&at91_gpio->chip, gpio); in gpio_irq_mask()
1566 if (pio) in gpio_irq_mask()
1567 writel_relaxed(mask, pio + PIO_IDR); in gpio_irq_mask()
1573 void __iomem *pio = at91_gpio->regbase; in gpio_irq_unmask() local
1574 unsigned mask = 1 << d->hwirq; in gpio_irq_unmask()
1577 gpiochip_enable_irq(&at91_gpio->chip, gpio); in gpio_irq_unmask()
1579 if (pio) in gpio_irq_unmask()
1580 writel_relaxed(mask, pio + PIO_IER); in gpio_irq_unmask()
1590 return -EINVAL; in gpio_irq_type()
1598 void __iomem *pio = at91_gpio->regbase; in alt_gpio_irq_type() local
1599 unsigned mask = 1 << d->hwirq; in alt_gpio_irq_type()
1604 writel_relaxed(mask, pio + PIO_ESR); in alt_gpio_irq_type()
1605 writel_relaxed(mask, pio + PIO_REHLSR); in alt_gpio_irq_type()
1609 writel_relaxed(mask, pio + PIO_ESR); in alt_gpio_irq_type()
1610 writel_relaxed(mask, pio + PIO_FELLSR); in alt_gpio_irq_type()
1614 writel_relaxed(mask, pio + PIO_LSR); in alt_gpio_irq_type()
1615 writel_relaxed(mask, pio + PIO_FELLSR); in alt_gpio_irq_type()
1619 writel_relaxed(mask, pio + PIO_LSR); in alt_gpio_irq_type()
1620 writel_relaxed(mask, pio + PIO_REHLSR); in alt_gpio_irq_type()
1628 writel_relaxed(mask, pio + PIO_AIMDR); in alt_gpio_irq_type()
1632 pr_warn("AT91: No type for GPIO irq offset %d\n", d->irq); in alt_gpio_irq_type()
1633 return -EINVAL; in alt_gpio_irq_type()
1637 writel_relaxed(mask, pio + PIO_AIMER); in alt_gpio_irq_type()
1650 unsigned mask = 1 << d->hwirq; in gpio_irq_set_wake()
1653 at91_gpio->wakeups |= mask; in gpio_irq_set_wake()
1655 at91_gpio->wakeups &= ~mask; in gpio_irq_set_wake()
1657 irq_set_irq_wake(at91_gpio->pioc_virq, state); in gpio_irq_set_wake()
1665 void __iomem *pio = at91_chip->regbase; in at91_gpio_suspend() local
1667 at91_chip->backups = readl_relaxed(pio + PIO_IMR); in at91_gpio_suspend()
1668 writel_relaxed(at91_chip->backups, pio + PIO_IDR); in at91_gpio_suspend()
1669 writel_relaxed(at91_chip->wakeups, pio + PIO_IER); in at91_gpio_suspend()
1671 if (!at91_chip->wakeups) in at91_gpio_suspend()
1672 clk_disable_unprepare(at91_chip->clock); in at91_gpio_suspend()
1674 dev_dbg(dev, "GPIO-%c may wake for %08x\n", in at91_gpio_suspend()
1675 'A' + at91_chip->id, at91_chip->wakeups); in at91_gpio_suspend()
1683 void __iomem *pio = at91_chip->regbase; in at91_gpio_resume() local
1685 if (!at91_chip->wakeups) in at91_gpio_resume()
1686 clk_prepare_enable(at91_chip->clock); in at91_gpio_resume()
1688 writel_relaxed(at91_chip->wakeups, pio + PIO_IDR); in at91_gpio_resume()
1689 writel_relaxed(at91_chip->backups, pio + PIO_IER); in at91_gpio_resume()
1699 void __iomem *pio = at91_gpio->regbase; in gpio_irq_handler() local
1709 isr = readl_relaxed(pio + PIO_ISR) & readl_relaxed(pio + PIO_IMR); in gpio_irq_handler()
1711 if (!at91_gpio->next) in gpio_irq_handler()
1713 at91_gpio = at91_gpio->next; in gpio_irq_handler()
1714 pio = at91_gpio->regbase; in gpio_irq_handler()
1715 gpio_chip = &at91_gpio->chip; in gpio_irq_handler()
1720 generic_handle_domain_irq(gpio_chip->irq.domain, n); in gpio_irq_handler()
1723 /* now it may re-trigger */ in gpio_irq_handler()
1729 struct device *dev = &pdev->dev; in at91_gpio_of_irq_setup()
1732 struct irq_data *d = irq_get_irq_data(at91_gpio->pioc_virq); in at91_gpio_of_irq_setup()
1739 return -ENOMEM; in at91_gpio_of_irq_setup()
1741 at91_gpio->pioc_hwirq = irqd_to_hwirq(d); in at91_gpio_of_irq_setup()
1743 gpio_irqchip->name = "GPIO"; in at91_gpio_of_irq_setup()
1744 gpio_irqchip->irq_request_resources = gpio_irq_request_resources; in at91_gpio_of_irq_setup()
1745 gpio_irqchip->irq_release_resources = gpio_irq_release_resources; in at91_gpio_of_irq_setup()
1746 gpio_irqchip->irq_ack = gpio_irq_ack; in at91_gpio_of_irq_setup()
1747 gpio_irqchip->irq_disable = gpio_irq_mask; in at91_gpio_of_irq_setup()
1748 gpio_irqchip->irq_mask = gpio_irq_mask; in at91_gpio_of_irq_setup()
1749 gpio_irqchip->irq_unmask = gpio_irq_unmask; in at91_gpio_of_irq_setup()
1750 gpio_irqchip->irq_set_wake = pm_ptr(gpio_irq_set_wake); in at91_gpio_of_irq_setup()
1751 gpio_irqchip->irq_set_type = at91_gpio->ops->irq_type; in at91_gpio_of_irq_setup()
1752 gpio_irqchip->flags = IRQCHIP_IMMUTABLE; in at91_gpio_of_irq_setup()
1754 /* Disable irqs of this PIO controller */ in at91_gpio_of_irq_setup()
1755 writel_relaxed(~0, at91_gpio->regbase + PIO_IDR); in at91_gpio_of_irq_setup()
1762 girq = &at91_gpio->chip.irq; in at91_gpio_of_irq_setup()
1764 girq->default_type = IRQ_TYPE_NONE; in at91_gpio_of_irq_setup()
1765 girq->handler = handle_edge_irq; in at91_gpio_of_irq_setup()
1772 gpiochip_prev = irq_get_handler_data(at91_gpio->pioc_virq); in at91_gpio_of_irq_setup()
1774 girq->parent_handler = gpio_irq_handler; in at91_gpio_of_irq_setup()
1775 girq->num_parents = 1; in at91_gpio_of_irq_setup()
1776 girq->parents = devm_kcalloc(dev, girq->num_parents, in at91_gpio_of_irq_setup()
1777 sizeof(*girq->parents), in at91_gpio_of_irq_setup()
1779 if (!girq->parents) in at91_gpio_of_irq_setup()
1780 return -ENOMEM; in at91_gpio_of_irq_setup()
1781 girq->parents[0] = at91_gpio->pioc_virq; in at91_gpio_of_irq_setup()
1788 if (prev->next) { in at91_gpio_of_irq_setup()
1789 prev = prev->next; in at91_gpio_of_irq_setup()
1791 prev->next = at91_gpio; in at91_gpio_of_irq_setup()
1796 return -EINVAL; in at91_gpio_of_irq_setup()
1815 { .compatible = "atmel,at91sam9x5-gpio", .data = &at91sam9x5_ops, },
1816 { .compatible = "atmel,at91rm9200-gpio", .data = &at91rm9200_ops },
1817 { .compatible = "microchip,sam9x60-gpio", .data = &sam9x60_ops },
1823 struct device *dev = &pdev->dev; in at91_gpio_probe()
1824 struct device_node *np = dev->of_node; in at91_gpio_probe()
1836 return dev_err_probe(dev, -EBUSY, "%d slot is occupied.\n", alias_idx); in at91_gpio_probe()
1844 return -ENOMEM; in at91_gpio_probe()
1846 at91_chip->regbase = devm_platform_ioremap_resource(pdev, 0); in at91_gpio_probe()
1847 if (IS_ERR(at91_chip->regbase)) in at91_gpio_probe()
1848 return PTR_ERR(at91_chip->regbase); in at91_gpio_probe()
1850 at91_chip->ops = device_get_match_data(dev); in at91_gpio_probe()
1851 at91_chip->pioc_virq = irq; in at91_gpio_probe()
1853 at91_chip->clock = devm_clk_get_enabled(dev, NULL); in at91_gpio_probe()
1854 if (IS_ERR(at91_chip->clock)) in at91_gpio_probe()
1855 return dev_err_probe(dev, PTR_ERR(at91_chip->clock), "failed to get clock, ignoring.\n"); in at91_gpio_probe()
1857 at91_chip->chip = at91_gpio_template; in at91_gpio_probe()
1858 at91_chip->id = alias_idx; in at91_gpio_probe()
1860 chip = &at91_chip->chip; in at91_gpio_probe()
1861 chip->label = dev_name(dev); in at91_gpio_probe()
1862 chip->parent = dev; in at91_gpio_probe()
1863 chip->owner = THIS_MODULE; in at91_gpio_probe()
1864 chip->base = alias_idx * MAX_NB_GPIO_PER_BANK; in at91_gpio_probe()
1866 if (!of_property_read_u32(np, "#gpio-lines", &ngpio)) { in at91_gpio_probe()
1868 dev_err(dev, "at91_gpio.%d, gpio-nb >= %d failback to %d\n", in at91_gpio_probe()
1871 chip->ngpio = ngpio; in at91_gpio_probe()
1874 names = devm_kasprintf_strarray(dev, "pio", chip->ngpio); in at91_gpio_probe()
1878 for (i = 0; i < chip->ngpio; i++) in at91_gpio_probe()
1879 strreplace(names[i], '-', alias_idx + 'A'); in at91_gpio_probe()
1881 chip->names = (const char *const *)names; in at91_gpio_probe()
1883 range = &at91_chip->range; in at91_gpio_probe()
1884 range->name = chip->label; in at91_gpio_probe()
1885 range->id = alias_idx; in at91_gpio_probe()
1886 range->pin_base = range->base = range->id * MAX_NB_GPIO_PER_BANK; in at91_gpio_probe()
1888 range->npins = chip->ngpio; in at91_gpio_probe()
1889 range->gc = chip; in at91_gpio_probe()
1903 dev_info(dev, "at address %p\n", at91_chip->regbase); in at91_gpio_probe()
1912 .name = "gpio-at91",
1921 .name = "pinctrl-at91",