1 // SPDX-License-Identifier: GPL-2.0
5  * Author:  Maxime Coquelin <mcoquelin.stm32@gmail.com>
11 #include <linux/hwspinlock.h>
23 #include <linux/pinctrl/pinconf-generic.h>
33 #include "../pinctrl-utils.h"
34 #include "pinctrl-stm32.h"
112 	struct hwspinlock *hwlock;
145 		return function - 1;  in stm32_gpio_get_alt()
156 	bank->pin_backup[offset] &= ~BIT(STM32_GPIO_BKP_VAL);  in stm32_gpio_backup_value()
157 	bank->pin_backup[offset] |= value << STM32_GPIO_BKP_VAL;  in stm32_gpio_backup_value()
163 	bank->pin_backup[offset] &= ~(STM32_GPIO_BKP_MODE_MASK |  in stm32_gpio_backup_mode()
165 	bank->pin_backup[offset] |= mode << STM32_GPIO_BKP_MODE_SHIFT;  in stm32_gpio_backup_mode()
166 	bank->pin_backup[offset] |= alt << STM32_GPIO_BKP_ALT_SHIFT;  in stm32_gpio_backup_mode()
172 	bank->pin_backup[offset] &= ~BIT(STM32_GPIO_BKP_TYPE);  in stm32_gpio_backup_driving()
173 	bank->pin_backup[offset] |= drive << STM32_GPIO_BKP_TYPE;  in stm32_gpio_backup_driving()
179 	bank->pin_backup[offset] &= ~STM32_GPIO_BKP_SPEED_MASK;  in stm32_gpio_backup_speed()
180 	bank->pin_backup[offset] |= speed << STM32_GPIO_BKP_SPEED_SHIFT;  in stm32_gpio_backup_speed()
186 	bank->pin_backup[offset] &= ~STM32_GPIO_BKP_PUPD_MASK;  in stm32_gpio_backup_bias()
187 	bank->pin_backup[offset] |= bias << STM32_GPIO_BKP_PUPD_SHIFT;  in stm32_gpio_backup_bias()
200 	clk_enable(bank->clk);  in __stm32_gpio_set()
202 	writel_relaxed(BIT(offset), bank->base + STM32_GPIO_BSRR);  in __stm32_gpio_set()
204 	clk_disable(bank->clk);  in __stm32_gpio_set()
210 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_gpio_request()
212 	int pin = offset + (bank->bank_nr * STM32_GPIO_PINS_PER_BANK);  in stm32_gpio_request()
214 	range = pinctrl_find_gpio_range_from_pin_nolock(pctl->pctl_dev, pin);  in stm32_gpio_request()
216 		dev_err(pctl->dev, "pin %d not in range.\n", pin);  in stm32_gpio_request()
217 		return -EINVAL;  in stm32_gpio_request()
220 	return pinctrl_gpio_request(chip->base + offset);  in stm32_gpio_request()
225 	pinctrl_gpio_free(chip->base + offset);  in stm32_gpio_free()
233 	clk_enable(bank->clk);  in stm32_gpio_get()
235 	ret = !!(readl_relaxed(bank->base + STM32_GPIO_IDR) & BIT(offset));  in stm32_gpio_get()
237 	clk_disable(bank->clk);  in stm32_gpio_get()
251 	return pinctrl_gpio_direction_input(chip->base + offset);  in stm32_gpio_direction_input()
260 	pinctrl_gpio_direction_output(chip->base + offset);  in stm32_gpio_direction_output()
271 	fwspec.fwnode = bank->fwnode;  in stm32_gpio_to_irq()
292 		ret = -EINVAL;  in stm32_gpio_get_direction()
311 	struct stm32_gpio_bank *bank = d->domain->host_data;  in stm32_gpio_irq_trigger()
315 	level = stm32_gpio_get(&bank->gpio_chip, d->hwirq);  in stm32_gpio_irq_trigger()
316 	if ((level == 0 && bank->irq_type[d->hwirq] == IRQ_TYPE_LEVEL_LOW) ||  in stm32_gpio_irq_trigger()
317 	    (level == 1 && bank->irq_type[d->hwirq] == IRQ_TYPE_LEVEL_HIGH))  in stm32_gpio_irq_trigger()
329 	struct stm32_gpio_bank *bank = d->domain->host_data;  in stm32_gpio_set_type()
345 		return -EINVAL;  in stm32_gpio_set_type()
348 	bank->irq_type[d->hwirq] = type;  in stm32_gpio_set_type()
355 	struct stm32_gpio_bank *bank = irq_data->domain->host_data;  in stm32_gpio_irq_request_resources()
356 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_gpio_irq_request_resources()
359 	ret = stm32_gpio_direction_input(&bank->gpio_chip, irq_data->hwirq);  in stm32_gpio_irq_request_resources()
363 	ret = gpiochip_lock_as_irq(&bank->gpio_chip, irq_data->hwirq);  in stm32_gpio_irq_request_resources()
365 		dev_err(pctl->dev, "unable to lock HW IRQ %lu for IRQ\n",  in stm32_gpio_irq_request_resources()
366 			irq_data->hwirq);  in stm32_gpio_irq_request_resources()
375 	struct stm32_gpio_bank *bank = irq_data->domain->host_data;  in stm32_gpio_irq_release_resources()
377 	gpiochip_unlock_as_irq(&bank->gpio_chip, irq_data->hwirq);  in stm32_gpio_irq_release_resources()
403 	if ((fwspec->param_count != 2) ||  in stm32_gpio_domain_translate()
404 	    (fwspec->param[0] >= STM32_GPIO_IRQ_LINE))  in stm32_gpio_domain_translate()
405 		return -EINVAL;  in stm32_gpio_domain_translate()
407 	*hwirq = fwspec->param[0];  in stm32_gpio_domain_translate()
408 	*type = fwspec->param[1];  in stm32_gpio_domain_translate()
415 	struct stm32_gpio_bank *bank = d->host_data;  in stm32_gpio_domain_activate()
416 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_gpio_domain_activate()
419 	if (pctl->hwlock) {  in stm32_gpio_domain_activate()
420 		ret = hwspin_lock_timeout_in_atomic(pctl->hwlock,  in stm32_gpio_domain_activate()
423 			dev_err(pctl->dev, "Can't get hwspinlock\n");  in stm32_gpio_domain_activate()
428 	regmap_field_write(pctl->irqmux[irq_data->hwirq], bank->bank_ioport_nr);  in stm32_gpio_domain_activate()
430 	if (pctl->hwlock)  in stm32_gpio_domain_activate()
431 		hwspin_unlock_in_atomic(pctl->hwlock);  in stm32_gpio_domain_activate()
440 	struct stm32_gpio_bank *bank = d->host_data;  in stm32_gpio_domain_alloc()
443 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_gpio_domain_alloc()
444 	irq_hw_number_t hwirq = fwspec->param[0];  in stm32_gpio_domain_alloc()
452 	spin_lock_irqsave(&pctl->irqmux_lock, flags);  in stm32_gpio_domain_alloc()
454 	if (pctl->irqmux_map & BIT(hwirq)) {  in stm32_gpio_domain_alloc()
455 		dev_err(pctl->dev, "irq line %ld already requested.\n", hwirq);  in stm32_gpio_domain_alloc()
456 		ret = -EBUSY;  in stm32_gpio_domain_alloc()
458 		pctl->irqmux_map |= BIT(hwirq);  in stm32_gpio_domain_alloc()
461 	spin_unlock_irqrestore(&pctl->irqmux_lock, flags);  in stm32_gpio_domain_alloc()
465 	parent_fwspec.fwnode = d->parent->fwnode;  in stm32_gpio_domain_alloc()
467 	parent_fwspec.param[0] = fwspec->param[0];  in stm32_gpio_domain_alloc()
468 	parent_fwspec.param[1] = fwspec->param[1];  in stm32_gpio_domain_alloc()
479 	struct stm32_gpio_bank *bank = d->host_data;  in stm32_gpio_domain_free()
480 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_gpio_domain_free()
482 	unsigned long flags, hwirq = irq_data->hwirq;  in stm32_gpio_domain_free()
486 	spin_lock_irqsave(&pctl->irqmux_lock, flags);  in stm32_gpio_domain_free()
487 	pctl->irqmux_map &= ~BIT(hwirq);  in stm32_gpio_domain_free()
488 	spin_unlock_irqrestore(&pctl->irqmux_lock, flags);  in stm32_gpio_domain_free()
504 	for (i = 0; i < pctl->ngroups; i++) {  in stm32_pctrl_find_group_by_pin()
505 		struct stm32_pinctrl_group *grp = pctl->groups + i;  in stm32_pctrl_find_group_by_pin()
507 		if (grp->pin == pin)  in stm32_pctrl_find_group_by_pin()
519 	for (i = 0; i < pctl->npins; i++) {  in stm32_pctrl_is_function_valid()
520 		const struct stm32_desc_pin *pin = pctl->pins + i;  in stm32_pctrl_is_function_valid()
521 		const struct stm32_desc_function *func = pin->functions;  in stm32_pctrl_is_function_valid()
523 		if (pin->pin.number != pin_num)  in stm32_pctrl_is_function_valid()
526 		while (func && func->name) {  in stm32_pctrl_is_function_valid()
527 			if (func->num == fnum)  in stm32_pctrl_is_function_valid()
535 	dev_err(pctl->dev, "invalid function %d on pin %d .\n", fnum, pin_num);  in stm32_pctrl_is_function_valid()
546 		return -ENOSPC;  in stm32_pctrl_dt_node_to_map_func()
549 	(*map)[*num_maps].data.mux.group = grp->name;  in stm32_pctrl_dt_node_to_map_func()
552 		return -EINVAL;  in stm32_pctrl_dt_node_to_map_func()
580 		dev_err(pctl->dev, "missing pins property in node %pOFn .\n",  in stm32_pctrl_dt_subnode_to_map()
582 		return -EINVAL;  in stm32_pctrl_dt_subnode_to_map()
593 	num_pins = pins->length / sizeof(u32);  in stm32_pctrl_dt_subnode_to_map()
602 		err = -EINVAL;  in stm32_pctrl_dt_subnode_to_map()
623 			err = -EINVAL;  in stm32_pctrl_dt_subnode_to_map()
629 			dev_err(pctl->dev, "unable to match pin %d to group\n",  in stm32_pctrl_dt_subnode_to_map()
631 			err = -EINVAL;  in stm32_pctrl_dt_subnode_to_map()
642 					reserved_maps, num_maps, grp->name,  in stm32_pctrl_dt_subnode_to_map()
684 	return pctl->ngroups;  in stm32_pctrl_get_groups_count()
692 	return pctl->groups[group].name;  in stm32_pctrl_get_group_name()
702 	*pins = (unsigned *)&pctl->groups[group].pin;  in stm32_pctrl_get_group_pins()
737 	*groups = pctl->grp_names;  in stm32_pmx_get_func_groups()
738 	*num_groups = pctl->ngroups;  in stm32_pmx_get_func_groups()
746 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_pmx_set_mode()
753 	clk_enable(bank->clk);  in stm32_pmx_set_mode()
754 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pmx_set_mode()
756 	if (pctl->hwlock) {  in stm32_pmx_set_mode()
757 		err = hwspin_lock_timeout_in_atomic(pctl->hwlock,  in stm32_pmx_set_mode()
760 			dev_err(pctl->dev, "Can't get hwspinlock\n");  in stm32_pmx_set_mode()
765 	val = readl_relaxed(bank->base + alt_offset);  in stm32_pmx_set_mode()
768 	writel_relaxed(val, bank->base + alt_offset);  in stm32_pmx_set_mode()
770 	val = readl_relaxed(bank->base + STM32_GPIO_MODER);  in stm32_pmx_set_mode()
773 	writel_relaxed(val, bank->base + STM32_GPIO_MODER);  in stm32_pmx_set_mode()
775 	if (pctl->hwlock)  in stm32_pmx_set_mode()
776 		hwspin_unlock_in_atomic(pctl->hwlock);  in stm32_pmx_set_mode()
781 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pmx_set_mode()
782 	clk_disable(bank->clk);  in stm32_pmx_set_mode()
795 	clk_enable(bank->clk);  in stm32_pmx_get_mode()
796 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pmx_get_mode()
798 	val = readl_relaxed(bank->base + alt_offset);  in stm32_pmx_get_mode()
802 	val = readl_relaxed(bank->base + STM32_GPIO_MODER);  in stm32_pmx_get_mode()
806 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pmx_get_mode()
807 	clk_disable(bank->clk);  in stm32_pmx_get_mode()
816 	struct stm32_pinctrl_group *g = pctl->groups + group;  in stm32_pmx_set_mux()
822 	ret = stm32_pctrl_is_function_valid(pctl, g->pin, function);  in stm32_pmx_set_mux()
824 		return -EINVAL;  in stm32_pmx_set_mux()
826 	range = pinctrl_find_gpio_range_from_pin(pctldev, g->pin);  in stm32_pmx_set_mux()
828 		dev_err(pctl->dev, "No gpio range defined.\n");  in stm32_pmx_set_mux()
829 		return -EINVAL;  in stm32_pmx_set_mux()
832 	bank = gpiochip_get_data(range->gc);  in stm32_pmx_set_mux()
833 	pin = stm32_gpio_pin(g->pin);  in stm32_pmx_set_mux()
845 	struct stm32_gpio_bank *bank = gpiochip_get_data(range->gc);  in stm32_pmx_gpio_set_direction()
865 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_pconf_set_driving()
870 	clk_enable(bank->clk);  in stm32_pconf_set_driving()
871 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_set_driving()
873 	if (pctl->hwlock) {  in stm32_pconf_set_driving()
874 		err = hwspin_lock_timeout_in_atomic(pctl->hwlock,  in stm32_pconf_set_driving()
877 			dev_err(pctl->dev, "Can't get hwspinlock\n");  in stm32_pconf_set_driving()
882 	val = readl_relaxed(bank->base + STM32_GPIO_TYPER);  in stm32_pconf_set_driving()
885 	writel_relaxed(val, bank->base + STM32_GPIO_TYPER);  in stm32_pconf_set_driving()
887 	if (pctl->hwlock)  in stm32_pconf_set_driving()
888 		hwspin_unlock_in_atomic(pctl->hwlock);  in stm32_pconf_set_driving()
893 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_set_driving()
894 	clk_disable(bank->clk);  in stm32_pconf_set_driving()
905 	clk_enable(bank->clk);  in stm32_pconf_get_driving()
906 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_get_driving()
908 	val = readl_relaxed(bank->base + STM32_GPIO_TYPER);  in stm32_pconf_get_driving()
911 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_get_driving()
912 	clk_disable(bank->clk);  in stm32_pconf_get_driving()
920 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_pconf_set_speed()
925 	clk_enable(bank->clk);  in stm32_pconf_set_speed()
926 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_set_speed()
928 	if (pctl->hwlock) {  in stm32_pconf_set_speed()
929 		err = hwspin_lock_timeout_in_atomic(pctl->hwlock,  in stm32_pconf_set_speed()
932 			dev_err(pctl->dev, "Can't get hwspinlock\n");  in stm32_pconf_set_speed()
937 	val = readl_relaxed(bank->base + STM32_GPIO_SPEEDR);  in stm32_pconf_set_speed()
940 	writel_relaxed(val, bank->base + STM32_GPIO_SPEEDR);  in stm32_pconf_set_speed()
942 	if (pctl->hwlock)  in stm32_pconf_set_speed()
943 		hwspin_unlock_in_atomic(pctl->hwlock);  in stm32_pconf_set_speed()
948 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_set_speed()
949 	clk_disable(bank->clk);  in stm32_pconf_set_speed()
960 	clk_enable(bank->clk);  in stm32_pconf_get_speed()
961 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_get_speed()
963 	val = readl_relaxed(bank->base + STM32_GPIO_SPEEDR);  in stm32_pconf_get_speed()
966 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_get_speed()
967 	clk_disable(bank->clk);  in stm32_pconf_get_speed()
975 	struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent);  in stm32_pconf_set_bias()
980 	clk_enable(bank->clk);  in stm32_pconf_set_bias()
981 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_set_bias()
983 	if (pctl->hwlock) {  in stm32_pconf_set_bias()
984 		err = hwspin_lock_timeout_in_atomic(pctl->hwlock,  in stm32_pconf_set_bias()
987 			dev_err(pctl->dev, "Can't get hwspinlock\n");  in stm32_pconf_set_bias()
992 	val = readl_relaxed(bank->base + STM32_GPIO_PUPDR);  in stm32_pconf_set_bias()
995 	writel_relaxed(val, bank->base + STM32_GPIO_PUPDR);  in stm32_pconf_set_bias()
997 	if (pctl->hwlock)  in stm32_pconf_set_bias()
998 		hwspin_unlock_in_atomic(pctl->hwlock);  in stm32_pconf_set_bias()
1003 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_set_bias()
1004 	clk_disable(bank->clk);  in stm32_pconf_set_bias()
1015 	clk_enable(bank->clk);  in stm32_pconf_get_bias()
1016 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_get_bias()
1018 	val = readl_relaxed(bank->base + STM32_GPIO_PUPDR);  in stm32_pconf_get_bias()
1021 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_get_bias()
1022 	clk_disable(bank->clk);  in stm32_pconf_get_bias()
1033 	clk_enable(bank->clk);  in stm32_pconf_get()
1034 	spin_lock_irqsave(&bank->lock, flags);  in stm32_pconf_get()
1037 		val = !!(readl_relaxed(bank->base + STM32_GPIO_IDR) &  in stm32_pconf_get()
1040 		val = !!(readl_relaxed(bank->base + STM32_GPIO_ODR) &  in stm32_pconf_get()
1043 	spin_unlock_irqrestore(&bank->lock, flags);  in stm32_pconf_get()
1044 	clk_disable(bank->clk);  in stm32_pconf_get()
1060 		dev_err(pctl->dev, "No gpio range defined.\n");  in stm32_pconf_parse_conf()
1061 		return -EINVAL;  in stm32_pconf_parse_conf()
1064 	bank = gpiochip_get_data(range->gc);  in stm32_pconf_parse_conf()
1091 		ret = -ENOTSUPP;  in stm32_pconf_parse_conf()
1103 	*config = pctl->groups[group].config;  in stm32_pconf_group_get()
1112 	struct stm32_pinctrl_group *g = &pctl->groups[group];  in stm32_pconf_group_set()
1116 		mutex_lock(&pctldev->mutex);  in stm32_pconf_group_set()
1117 		ret = stm32_pconf_parse_conf(pctldev, g->pin,  in stm32_pconf_group_set()
1120 		mutex_unlock(&pctldev->mutex);  in stm32_pconf_group_set()
1124 		g->config = configs[i];  in stm32_pconf_group_set()
1166 	bank = gpiochip_get_data(range->gc);  in stm32_pconf_dbg_show()
1178 		seq_printf(s, "- %s - %s",  in stm32_pconf_dbg_show()
1188 		seq_printf(s, "- %s - %s - %s - %s %s",  in stm32_pconf_dbg_show()
1199 		seq_printf(s, "%d - %s - %s - %s %s", alt,  in stm32_pconf_dbg_show()
1221 	struct stm32_gpio_bank *bank = &pctl->banks[pctl->nbanks];  in stm32_gpiolib_register_bank()
1223 	struct pinctrl_gpio_range *range = &bank->range;  in stm32_gpiolib_register_bank()
1225 	struct device *dev = pctl->dev;  in stm32_gpiolib_register_bank()
1230 	if (!IS_ERR(bank->rstc))  in stm32_gpiolib_register_bank()
1231 		reset_control_deassert(bank->rstc);  in stm32_gpiolib_register_bank()
1234 		return -ENODEV;  in stm32_gpiolib_register_bank()
1236 	bank->base = devm_ioremap_resource(dev, &res);  in stm32_gpiolib_register_bank()
1237 	if (IS_ERR(bank->base))  in stm32_gpiolib_register_bank()
1238 		return PTR_ERR(bank->base);  in stm32_gpiolib_register_bank()
1240 	err = clk_prepare(bank->clk);  in stm32_gpiolib_register_bank()
1246 	bank->gpio_chip = stm32_gpio_template;  in stm32_gpiolib_register_bank()
1248 	of_property_read_string(np, "st,bank-name", &bank->gpio_chip.label);  in stm32_gpiolib_register_bank()
1250 	if (!of_parse_phandle_with_fixed_args(np, "gpio-ranges", 3, i, &args)) {  in stm32_gpiolib_register_bank()
1252 		bank->gpio_chip.base = args.args[1];  in stm32_gpiolib_register_bank()
1255 		while (!of_parse_phandle_with_fixed_args(np, "gpio-ranges", 3,  in stm32_gpiolib_register_bank()
1259 		bank_nr = pctl->nbanks;  in stm32_gpiolib_register_bank()
1260 		bank->gpio_chip.base = bank_nr * STM32_GPIO_PINS_PER_BANK;  in stm32_gpiolib_register_bank()
1261 		range->name = bank->gpio_chip.label;  in stm32_gpiolib_register_bank()
1262 		range->id = bank_nr;  in stm32_gpiolib_register_bank()
1263 		range->pin_base = range->id * STM32_GPIO_PINS_PER_BANK;  in stm32_gpiolib_register_bank()
1264 		range->base = range->id * STM32_GPIO_PINS_PER_BANK;  in stm32_gpiolib_register_bank()
1265 		range->npins = npins;  in stm32_gpiolib_register_bank()
1266 		range->gc = &bank->gpio_chip;  in stm32_gpiolib_register_bank()
1267 		pinctrl_add_gpio_range(pctl->pctl_dev,  in stm32_gpiolib_register_bank()
1268 				       &pctl->banks[bank_nr].range);  in stm32_gpiolib_register_bank()
1271 	if (of_property_read_u32(np, "st,bank-ioport", &bank_ioport_nr))  in stm32_gpiolib_register_bank()
1274 	bank->gpio_chip.base = bank_nr * STM32_GPIO_PINS_PER_BANK;  in stm32_gpiolib_register_bank()
1276 	bank->gpio_chip.ngpio = npins;  in stm32_gpiolib_register_bank()
1277 	bank->gpio_chip.of_node = np;  in stm32_gpiolib_register_bank()
1278 	bank->gpio_chip.parent = dev;  in stm32_gpiolib_register_bank()
1279 	bank->bank_nr = bank_nr;  in stm32_gpiolib_register_bank()
1280 	bank->bank_ioport_nr = bank_ioport_nr;  in stm32_gpiolib_register_bank()
1281 	spin_lock_init(&bank->lock);  in stm32_gpiolib_register_bank()
1284 	bank->fwnode = of_node_to_fwnode(np);  in stm32_gpiolib_register_bank()
1286 	bank->domain = irq_domain_create_hierarchy(pctl->domain, 0,  in stm32_gpiolib_register_bank()
1287 					STM32_GPIO_IRQ_LINE, bank->fwnode,  in stm32_gpiolib_register_bank()
1290 	if (!bank->domain)  in stm32_gpiolib_register_bank()
1291 		return -ENODEV;  in stm32_gpiolib_register_bank()
1293 	err = gpiochip_add_data(&bank->gpio_chip, bank);  in stm32_gpiolib_register_bank()
1299 	dev_info(dev, "%s bank added\n", bank->gpio_chip.label);  in stm32_gpiolib_register_bank()
1308 	if (!of_find_property(np, "interrupt-parent", NULL))  in stm32_pctrl_get_irq_domain()
1313 		return ERR_PTR(-ENXIO);  in stm32_pctrl_get_irq_domain()
1318 		return ERR_PTR(-EPROBE_DEFER);  in stm32_pctrl_get_irq_domain()
1326 	struct device_node *np = pdev->dev.of_node;  in stm32_pctrl_dt_setup_irq()
1327 	struct device *dev = &pdev->dev;  in stm32_pctrl_dt_setup_irq()
1332 	pctl->regmap = syscon_regmap_lookup_by_phandle(np, "st,syscfg");  in stm32_pctrl_dt_setup_irq()
1333 	if (IS_ERR(pctl->regmap))  in stm32_pctrl_dt_setup_irq()
1334 		return PTR_ERR(pctl->regmap);  in stm32_pctrl_dt_setup_irq()
1336 	rm = pctl->regmap;  in stm32_pctrl_dt_setup_irq()
1353 		mux.msb = mux.lsb + mask_width - 1;  in stm32_pctrl_dt_setup_irq()
1358 		pctl->irqmux[i] = devm_regmap_field_alloc(dev, rm, mux);  in stm32_pctrl_dt_setup_irq()
1359 		if (IS_ERR(pctl->irqmux[i]))  in stm32_pctrl_dt_setup_irq()
1360 			return PTR_ERR(pctl->irqmux[i]);  in stm32_pctrl_dt_setup_irq()
1371 	pctl->ngroups = pctl->npins;  in stm32_pctrl_build_state()
1374 	pctl->groups = devm_kcalloc(&pdev->dev, pctl->ngroups,  in stm32_pctrl_build_state()
1375 				    sizeof(*pctl->groups), GFP_KERNEL);  in stm32_pctrl_build_state()
1376 	if (!pctl->groups)  in stm32_pctrl_build_state()
1377 		return -ENOMEM;  in stm32_pctrl_build_state()
1380 	pctl->grp_names = devm_kcalloc(&pdev->dev, pctl->ngroups,  in stm32_pctrl_build_state()
1381 				       sizeof(*pctl->grp_names), GFP_KERNEL);  in stm32_pctrl_build_state()
1382 	if (!pctl->grp_names)  in stm32_pctrl_build_state()
1383 		return -ENOMEM;  in stm32_pctrl_build_state()
1385 	for (i = 0; i < pctl->npins; i++) {  in stm32_pctrl_build_state()
1386 		const struct stm32_desc_pin *pin = pctl->pins + i;  in stm32_pctrl_build_state()
1387 		struct stm32_pinctrl_group *group = pctl->groups + i;  in stm32_pctrl_build_state()
1389 		group->name = pin->pin.name;  in stm32_pctrl_build_state()
1390 		group->pin = pin->pin.number;  in stm32_pctrl_build_state()
1391 		pctl->grp_names[i] = pin->pin.name;  in stm32_pctrl_build_state()
1403 	for (i = 0; i < pctl->match_data->npins; i++) {  in stm32_pctrl_create_pins_tab()
1404 		p = pctl->match_data->pins + i;  in stm32_pctrl_create_pins_tab()
1405 		if (pctl->pkg && !(pctl->pkg & p->pkg))  in stm32_pctrl_create_pins_tab()
1407 		pins->pin = p->pin;  in stm32_pctrl_create_pins_tab()
1408 		pins->functions = p->functions;  in stm32_pctrl_create_pins_tab()
1413 	pctl->npins = nb_pins_available;  in stm32_pctrl_create_pins_tab()
1421 	if (of_property_read_u32(np, "st,package", &pctl->pkg)) {  in stm32_pctl_get_package()
1422 		pctl->pkg = 0;  in stm32_pctl_get_package()
1423 		dev_warn(pctl->dev, "No package detected, use default one\n");  in stm32_pctl_get_package()
1425 		dev_dbg(pctl->dev, "package detected: %x\n", pctl->pkg);  in stm32_pctl_get_package()
1431 	struct device_node *np = pdev->dev.of_node;  in stm32_pctl_probe()
1434 	struct device *dev = &pdev->dev;  in stm32_pctl_probe()
1440 		return -EINVAL;  in stm32_pctl_probe()
1442 	match = of_match_device(dev->driver->of_match_table, dev);  in stm32_pctl_probe()
1443 	if (!match || !match->data)  in stm32_pctl_probe()
1444 		return -EINVAL;  in stm32_pctl_probe()
1446 	if (!of_find_property(np, "pins-are-numbered", NULL)) {  in stm32_pctl_probe()
1447 		dev_err(dev, "only support pins-are-numbered format\n");  in stm32_pctl_probe()
1448 		return -EINVAL;  in stm32_pctl_probe()
1453 		return -ENOMEM;  in stm32_pctl_probe()
1458 	pctl->domain = stm32_pctrl_get_irq_domain(np);  in stm32_pctl_probe()
1459 	if (IS_ERR(pctl->domain))  in stm32_pctl_probe()
1460 		return PTR_ERR(pctl->domain);  in stm32_pctl_probe()
1462 	/* hwspinlock is optional */  in stm32_pctl_probe()
1463 	hwlock_id = of_hwspin_lock_get_id(pdev->dev.of_node, 0);  in stm32_pctl_probe()
1465 		if (hwlock_id == -EPROBE_DEFER)  in stm32_pctl_probe()
1468 		pctl->hwlock = hwspin_lock_request_specific(hwlock_id);  in stm32_pctl_probe()
1471 	spin_lock_init(&pctl->irqmux_lock);  in stm32_pctl_probe()
1473 	pctl->dev = dev;  in stm32_pctl_probe()
1474 	pctl->match_data = match->data;  in stm32_pctl_probe()
1479 	pctl->pins = devm_kcalloc(pctl->dev, pctl->match_data->npins,  in stm32_pctl_probe()
1480 				  sizeof(*pctl->pins), GFP_KERNEL);  in stm32_pctl_probe()
1481 	if (!pctl->pins)  in stm32_pctl_probe()
1482 		return -ENOMEM;  in stm32_pctl_probe()
1484 	ret = stm32_pctrl_create_pins_tab(pctl, pctl->pins);  in stm32_pctl_probe()
1491 		return -EINVAL;  in stm32_pctl_probe()
1494 	if (pctl->domain) {  in stm32_pctl_probe()
1500 	pins = devm_kcalloc(&pdev->dev, pctl->npins, sizeof(*pins),  in stm32_pctl_probe()
1503 		return -ENOMEM;  in stm32_pctl_probe()
1505 	for (i = 0; i < pctl->npins; i++)  in stm32_pctl_probe()
1506 		pins[i] = pctl->pins[i].pin;  in stm32_pctl_probe()
1508 	pctl->pctl_desc.name = dev_name(&pdev->dev);  in stm32_pctl_probe()
1509 	pctl->pctl_desc.owner = THIS_MODULE;  in stm32_pctl_probe()
1510 	pctl->pctl_desc.pins = pins;  in stm32_pctl_probe()
1511 	pctl->pctl_desc.npins = pctl->npins;  in stm32_pctl_probe()
1512 	pctl->pctl_desc.link_consumers = true;  in stm32_pctl_probe()
1513 	pctl->pctl_desc.confops = &stm32_pconf_ops;  in stm32_pctl_probe()
1514 	pctl->pctl_desc.pctlops = &stm32_pctrl_ops;  in stm32_pctl_probe()
1515 	pctl->pctl_desc.pmxops = &stm32_pmx_ops;  in stm32_pctl_probe()
1516 	pctl->dev = &pdev->dev;  in stm32_pctl_probe()
1518 	pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->pctl_desc,  in stm32_pctl_probe()
1521 	if (IS_ERR(pctl->pctl_dev)) {  in stm32_pctl_probe()
1522 		dev_err(&pdev->dev, "Failed pinctrl registration\n");  in stm32_pctl_probe()
1523 		return PTR_ERR(pctl->pctl_dev);  in stm32_pctl_probe()
1527 		if (of_property_read_bool(child, "gpio-controller"))  in stm32_pctl_probe()
1532 		return -EINVAL;  in stm32_pctl_probe()
1534 	pctl->banks = devm_kcalloc(dev, banks, sizeof(*pctl->banks),  in stm32_pctl_probe()
1536 	if (!pctl->banks)  in stm32_pctl_probe()
1537 		return -ENOMEM;  in stm32_pctl_probe()
1541 		struct stm32_gpio_bank *bank = &pctl->banks[i];  in stm32_pctl_probe()
1543 		if (of_property_read_bool(child, "gpio-controller")) {  in stm32_pctl_probe()
1544 			bank->rstc = of_reset_control_get_exclusive(child,  in stm32_pctl_probe()
1546 			if (PTR_ERR(bank->rstc) == -EPROBE_DEFER) {  in stm32_pctl_probe()
1548 				return -EPROBE_DEFER;  in stm32_pctl_probe()
1551 			bank->clk = of_clk_get_by_name(child, NULL);  in stm32_pctl_probe()
1552 			if (IS_ERR(bank->clk)) {  in stm32_pctl_probe()
1553 				if (PTR_ERR(bank->clk) != -EPROBE_DEFER)  in stm32_pctl_probe()
1556 						PTR_ERR(bank->clk));  in stm32_pctl_probe()
1558 				return PTR_ERR(bank->clk);  in stm32_pctl_probe()
1565 		if (of_property_read_bool(child, "gpio-controller")) {  in stm32_pctl_probe()
1572 			pctl->nbanks++;  in stm32_pctl_probe()
1576 	dev_info(dev, "Pinctrl STM32 initialized\n");  in stm32_pctl_probe()
1584 	const struct pin_desc *desc = pin_desc_get(pctl->pctl_dev, pin);  in stm32_pinctrl_restore_gpio_regs()
1591 	range = pinctrl_find_gpio_range_from_pin(pctl->pctl_dev, pin);  in stm32_pinctrl_restore_gpio_regs()
1595 	pin_is_irq = gpiochip_line_is_irq(range->gc, offset);  in stm32_pinctrl_restore_gpio_regs()
1597 	if (!desc || (!pin_is_irq && !desc->gpio_owner))  in stm32_pinctrl_restore_gpio_regs()
1600 	bank = gpiochip_get_data(range->gc);  in stm32_pinctrl_restore_gpio_regs()
1602 	alt = bank->pin_backup[offset] & STM32_GPIO_BKP_ALT_MASK;  in stm32_pinctrl_restore_gpio_regs()
1604 	mode = bank->pin_backup[offset] & STM32_GPIO_BKP_MODE_MASK;  in stm32_pinctrl_restore_gpio_regs()
1612 		val = bank->pin_backup[offset] & BIT(STM32_GPIO_BKP_VAL);  in stm32_pinctrl_restore_gpio_regs()
1617 	val = bank->pin_backup[offset] & BIT(STM32_GPIO_BKP_TYPE);  in stm32_pinctrl_restore_gpio_regs()
1623 	val = bank->pin_backup[offset] & STM32_GPIO_BKP_SPEED_MASK;  in stm32_pinctrl_restore_gpio_regs()
1629 	val = bank->pin_backup[offset] & STM32_GPIO_BKP_PUPD_MASK;  in stm32_pinctrl_restore_gpio_regs()
1636 		regmap_field_write(pctl->irqmux[offset], bank->bank_ioport_nr);  in stm32_pinctrl_restore_gpio_regs()
1644 	struct stm32_pinctrl_group *g = pctl->groups;  in stm32_pinctrl_resume()
1647 	for (i = 0; i < pctl->ngroups; i++, g++)  in stm32_pinctrl_resume()
1648 		stm32_pinctrl_restore_gpio_regs(pctl, g->pin);  in stm32_pinctrl_resume()