105 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_get()  local
111 	ret = regmap_read(pctl->stmfx->map, reg, &value);  in stmfx_gpio_get()
118 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_set()  local
122 	regmap_write_bits(pctl->stmfx->map, reg + get_reg(offset),  in stmfx_gpio_set()
128 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_get_direction()  local
134 	ret = regmap_read(pctl->stmfx->map, reg, &val);  in stmfx_gpio_get_direction()
149 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_direction_input()  local
153 	return regmap_write_bits(pctl->stmfx->map, reg, mask, 0);  in stmfx_gpio_direction_input()
159 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_direction_output()  local
165 	return regmap_write_bits(pctl->stmfx->map, reg, mask, mask);  in stmfx_gpio_direction_output()
168 static int stmfx_pinconf_get_pupd(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_get_pupd()  argument
175 	ret = regmap_read(pctl->stmfx->map, reg, &pupd);  in stmfx_pinconf_get_pupd()
182 static int stmfx_pinconf_set_pupd(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_set_pupd()  argument
188 	return regmap_write_bits(pctl->stmfx->map, reg, mask, pupd ? mask : 0);  in stmfx_pinconf_set_pupd()
191 static int stmfx_pinconf_get_type(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_get_type()  argument
198 	ret = regmap_read(pctl->stmfx->map, reg, &type);  in stmfx_pinconf_get_type()
205 static int stmfx_pinconf_set_type(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_set_type()  argument
211 	return regmap_write_bits(pctl->stmfx->map, reg, mask, type ? mask : 0);  in stmfx_pinconf_set_type()
217 	struct stmfx_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in stmfx_pinconf_get()  local
227 	dir = stmfx_gpio_get_direction(&pctl->gpio_chip, pin);  in stmfx_pinconf_get()
237 	type = stmfx_pinconf_get_type(pctl, pin);  in stmfx_pinconf_get()
240 	pupd = stmfx_pinconf_get_pupd(pctl, pin);  in stmfx_pinconf_get()
269 		ret = stmfx_gpio_get(&pctl->gpio_chip, pin);  in stmfx_pinconf_get()
287 	struct stmfx_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in stmfx_pinconf_set()  local
307 			ret = stmfx_pinconf_set_type(pctl, pin, 0);  in stmfx_pinconf_set()
312 			ret = stmfx_pinconf_set_type(pctl, pin, 1);  in stmfx_pinconf_set()
315 			ret = stmfx_pinconf_set_pupd(pctl, pin, 0);  in stmfx_pinconf_set()
320 			ret = stmfx_pinconf_set_type(pctl, pin, 1);  in stmfx_pinconf_set()
323 			ret = stmfx_pinconf_set_pupd(pctl, pin, 1);  in stmfx_pinconf_set()
328 			ret = stmfx_pinconf_set_type(pctl, pin, 1);  in stmfx_pinconf_set()
333 			ret = stmfx_gpio_direction_output(&pctl->gpio_chip,  in stmfx_pinconf_set()
349 	struct stmfx_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in stmfx_pinconf_dbg_show()  local
357 	dir = stmfx_gpio_get_direction(&pctl->gpio_chip, offset);  in stmfx_pinconf_dbg_show()
360 	type = stmfx_pinconf_get_type(pctl, offset);  in stmfx_pinconf_dbg_show()
363 	pupd = stmfx_pinconf_get_pupd(pctl, offset);  in stmfx_pinconf_dbg_show()
366 	val = stmfx_gpio_get(&pctl->gpio_chip, offset);  in stmfx_pinconf_dbg_show()
423 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_mask()  local
427 	pctl->irq_gpi_src[reg] &= ~mask;  in stmfx_pinctrl_irq_mask()
433 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_unmask()  local
437 	pctl->irq_gpi_src[reg] |= mask;  in stmfx_pinctrl_irq_unmask()
443 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_set_type()  local
451 		pctl->irq_gpi_evt[reg] |= mask;  in stmfx_pinctrl_irq_set_type()
454 		pctl->irq_gpi_evt[reg] &= ~mask;  in stmfx_pinctrl_irq_set_type()
459 		pctl->irq_gpi_type[reg] |= mask;  in stmfx_pinctrl_irq_set_type()
461 		pctl->irq_gpi_type[reg] &= ~mask;  in stmfx_pinctrl_irq_set_type()
471 		pctl->irq_toggle_edge[reg] |= mask;  in stmfx_pinctrl_irq_set_type()
473 		pctl->irq_toggle_edge[reg] &= mask;  in stmfx_pinctrl_irq_set_type()
481 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_bus_lock()  local
483 	mutex_lock(&pctl->lock);  in stmfx_pinctrl_irq_bus_lock()
489 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_bus_sync_unlock()  local
498 	if (pctl->irq_toggle_edge[reg] & mask) {  in stmfx_pinctrl_irq_bus_sync_unlock()
500 			pctl->irq_gpi_type[reg] &= ~mask;  in stmfx_pinctrl_irq_bus_sync_unlock()
502 			pctl->irq_gpi_type[reg] |= mask;  in stmfx_pinctrl_irq_bus_sync_unlock()
505 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_EVT,  in stmfx_pinctrl_irq_bus_sync_unlock()
506 			  pctl->irq_gpi_evt, NR_GPIO_REGS);  in stmfx_pinctrl_irq_bus_sync_unlock()
507 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_TYPE,  in stmfx_pinctrl_irq_bus_sync_unlock()
508 			  pctl->irq_gpi_type, NR_GPIO_REGS);  in stmfx_pinctrl_irq_bus_sync_unlock()
509 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_irq_bus_sync_unlock()
510 			  pctl->irq_gpi_src, NR_GPIO_REGS);  in stmfx_pinctrl_irq_bus_sync_unlock()
512 	mutex_unlock(&pctl->lock);  in stmfx_pinctrl_irq_bus_sync_unlock()
534 static void stmfx_pinctrl_irq_toggle_trigger(struct stmfx_pinctrl *pctl,  in stmfx_pinctrl_irq_toggle_trigger()  argument
541 	if (!(pctl->irq_toggle_edge[reg] & mask))  in stmfx_pinctrl_irq_toggle_trigger()
544 	val = stmfx_gpio_get(&pctl->gpio_chip, offset);  in stmfx_pinctrl_irq_toggle_trigger()
549 		pctl->irq_gpi_type[reg] &= mask;  in stmfx_pinctrl_irq_toggle_trigger()
550 		regmap_write_bits(pctl->stmfx->map,  in stmfx_pinctrl_irq_toggle_trigger()
555 		pctl->irq_gpi_type[reg] |= mask;  in stmfx_pinctrl_irq_toggle_trigger()
556 		regmap_write_bits(pctl->stmfx->map,  in stmfx_pinctrl_irq_toggle_trigger()
564 	struct stmfx_pinctrl *pctl = (struct stmfx_pinctrl *)dev_id;  in stmfx_pinctrl_irq_thread_fn()  local
565 	struct gpio_chip *gc = &pctl->gpio_chip;  in stmfx_pinctrl_irq_thread_fn()
571 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_IRQ_GPI_PENDING,  in stmfx_pinctrl_irq_thread_fn()
576 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_irq_thread_fn()
582 		stmfx_pinctrl_irq_toggle_trigger(pctl, n);  in stmfx_pinctrl_irq_thread_fn()
585 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_irq_thread_fn()
586 			  pctl->irq_gpi_src, NR_GPIO_REGS);  in stmfx_pinctrl_irq_thread_fn()
591 static int stmfx_pinctrl_gpio_function_enable(struct stmfx_pinctrl *pctl)  in stmfx_pinctrl_gpio_function_enable()  argument
594 	struct pinctrl_dev *pctl_dev = pctl->pctl_dev;  in stmfx_pinctrl_gpio_function_enable()
597 	pctl->gpio_valid_mask = GENMASK(15, 0);  in stmfx_pinctrl_gpio_function_enable()
602 		pctl->gpio_valid_mask |= GENMASK(19, 16);  in stmfx_pinctrl_gpio_function_enable()
608 		pctl->gpio_valid_mask |= GENMASK(23, 20);  in stmfx_pinctrl_gpio_function_enable()
611 	return stmfx_function_enable(pctl->stmfx, func);  in stmfx_pinctrl_gpio_function_enable()
618 	struct stmfx_pinctrl *pctl;  in stmfx_pinctrl_probe()  local
622 	pctl = devm_kzalloc(stmfx->dev, sizeof(*pctl), GFP_KERNEL);  in stmfx_pinctrl_probe()
623 	if (!pctl)  in stmfx_pinctrl_probe()
626 	platform_set_drvdata(pdev, pctl);  in stmfx_pinctrl_probe()
628 	pctl->dev = &pdev->dev;  in stmfx_pinctrl_probe()
629 	pctl->stmfx = stmfx;  in stmfx_pinctrl_probe()
632 		dev_err(pctl->dev, "missing required gpio-ranges property\n");  in stmfx_pinctrl_probe()
640 	mutex_init(&pctl->lock);  in stmfx_pinctrl_probe()
643 	pctl->pctl_desc.name = "stmfx-pinctrl";  in stmfx_pinctrl_probe()
644 	pctl->pctl_desc.pctlops = &stmfx_pinctrl_ops;  in stmfx_pinctrl_probe()
645 	pctl->pctl_desc.confops = &stmfx_pinconf_ops;  in stmfx_pinctrl_probe()
646 	pctl->pctl_desc.pins = stmfx_pins;  in stmfx_pinctrl_probe()
647 	pctl->pctl_desc.npins = ARRAY_SIZE(stmfx_pins);  in stmfx_pinctrl_probe()
648 	pctl->pctl_desc.owner = THIS_MODULE;  in stmfx_pinctrl_probe()
649 	pctl->pctl_desc.link_consumers = true;  in stmfx_pinctrl_probe()
651 	ret = devm_pinctrl_register_and_init(pctl->dev, &pctl->pctl_desc,  in stmfx_pinctrl_probe()
652 					     pctl, &pctl->pctl_dev);  in stmfx_pinctrl_probe()
654 		dev_err(pctl->dev, "pinctrl registration failed\n");  in stmfx_pinctrl_probe()
658 	ret = pinctrl_enable(pctl->pctl_dev);  in stmfx_pinctrl_probe()
660 		dev_err(pctl->dev, "pinctrl enable failed\n");  in stmfx_pinctrl_probe()
665 	pctl->gpio_chip.label = "stmfx-gpio";  in stmfx_pinctrl_probe()
666 	pctl->gpio_chip.parent = pctl->dev;  in stmfx_pinctrl_probe()
667 	pctl->gpio_chip.get_direction = stmfx_gpio_get_direction;  in stmfx_pinctrl_probe()
668 	pctl->gpio_chip.direction_input = stmfx_gpio_direction_input;  in stmfx_pinctrl_probe()
669 	pctl->gpio_chip.direction_output = stmfx_gpio_direction_output;  in stmfx_pinctrl_probe()
670 	pctl->gpio_chip.get = stmfx_gpio_get;  in stmfx_pinctrl_probe()
671 	pctl->gpio_chip.set = stmfx_gpio_set;  in stmfx_pinctrl_probe()
672 	pctl->gpio_chip.set_config = gpiochip_generic_config;  in stmfx_pinctrl_probe()
673 	pctl->gpio_chip.base = -1;  in stmfx_pinctrl_probe()
674 	pctl->gpio_chip.ngpio = pctl->pctl_desc.npins;  in stmfx_pinctrl_probe()
675 	pctl->gpio_chip.can_sleep = true;  in stmfx_pinctrl_probe()
676 	pctl->gpio_chip.of_node = np;  in stmfx_pinctrl_probe()
678 	pctl->irq_chip.name = dev_name(pctl->dev);  in stmfx_pinctrl_probe()
679 	pctl->irq_chip.irq_mask = stmfx_pinctrl_irq_mask;  in stmfx_pinctrl_probe()
680 	pctl->irq_chip.irq_unmask = stmfx_pinctrl_irq_unmask;  in stmfx_pinctrl_probe()
681 	pctl->irq_chip.irq_set_type = stmfx_pinctrl_irq_set_type;  in stmfx_pinctrl_probe()
682 	pctl->irq_chip.irq_bus_lock = stmfx_pinctrl_irq_bus_lock;  in stmfx_pinctrl_probe()
683 	pctl->irq_chip.irq_bus_sync_unlock = stmfx_pinctrl_irq_bus_sync_unlock;  in stmfx_pinctrl_probe()
684 	pctl->irq_chip.irq_request_resources = stmfx_gpio_irq_request_resources;  in stmfx_pinctrl_probe()
685 	pctl->irq_chip.irq_release_resources = stmfx_gpio_irq_release_resources;  in stmfx_pinctrl_probe()
687 	girq = &pctl->gpio_chip.irq;  in stmfx_pinctrl_probe()
688 	girq->chip = &pctl->irq_chip;  in stmfx_pinctrl_probe()
697 	ret = devm_gpiochip_add_data(pctl->dev, &pctl->gpio_chip, pctl);  in stmfx_pinctrl_probe()
699 		dev_err(pctl->dev, "gpio_chip registration failed\n");  in stmfx_pinctrl_probe()
703 	ret = stmfx_pinctrl_gpio_function_enable(pctl);  in stmfx_pinctrl_probe()
707 	ret = devm_request_threaded_irq(pctl->dev, irq, NULL,  in stmfx_pinctrl_probe()
710 					pctl->irq_chip.name, pctl);  in stmfx_pinctrl_probe()
712 		dev_err(pctl->dev, "cannot request irq%d\n", irq);  in stmfx_pinctrl_probe()
716 	dev_info(pctl->dev,  in stmfx_pinctrl_probe()
717 		 "%ld GPIOs available\n", hweight_long(pctl->gpio_valid_mask));  in stmfx_pinctrl_probe()
733 static int stmfx_pinctrl_backup_regs(struct stmfx_pinctrl *pctl)  in stmfx_pinctrl_backup_regs()  argument
737 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_STATE,  in stmfx_pinctrl_backup_regs()
738 			       &pctl->bkp_gpio_state, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
741 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_DIR,  in stmfx_pinctrl_backup_regs()
742 			       &pctl->bkp_gpio_dir, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
745 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_TYPE,  in stmfx_pinctrl_backup_regs()
746 			       &pctl->bkp_gpio_type, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
749 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_PUPD,  in stmfx_pinctrl_backup_regs()
750 			       &pctl->bkp_gpio_pupd, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
757 static int stmfx_pinctrl_restore_regs(struct stmfx_pinctrl *pctl)  in stmfx_pinctrl_restore_regs()  argument
761 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_DIR,  in stmfx_pinctrl_restore_regs()
762 				pctl->bkp_gpio_dir, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
765 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_TYPE,  in stmfx_pinctrl_restore_regs()
766 				pctl->bkp_gpio_type, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
769 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_PUPD,  in stmfx_pinctrl_restore_regs()
770 				pctl->bkp_gpio_pupd, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
773 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPO_SET,  in stmfx_pinctrl_restore_regs()
774 				pctl->bkp_gpio_state, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
777 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_EVT,  in stmfx_pinctrl_restore_regs()
778 				pctl->irq_gpi_evt, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
781 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_TYPE,  in stmfx_pinctrl_restore_regs()
782 				pctl->irq_gpi_type, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
785 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_restore_regs()
786 				pctl->irq_gpi_src, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
795 	struct stmfx_pinctrl *pctl = dev_get_drvdata(dev);  in stmfx_pinctrl_suspend()  local
798 	ret = stmfx_pinctrl_backup_regs(pctl);  in stmfx_pinctrl_suspend()
800 		dev_err(pctl->dev, "registers backup failure\n");  in stmfx_pinctrl_suspend()
809 	struct stmfx_pinctrl *pctl = dev_get_drvdata(dev);  in stmfx_pinctrl_resume()  local
812 	ret = stmfx_pinctrl_restore_regs(pctl);  in stmfx_pinctrl_resume()
814 		dev_err(pctl->dev, "registers restoration failure\n");  in stmfx_pinctrl_resume()