106 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_get()  local
112 	ret = regmap_read(pctl->stmfx->map, reg, &value);  in stmfx_gpio_get()
119 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_set()  local
123 	regmap_write_bits(pctl->stmfx->map, reg + get_reg(offset),  in stmfx_gpio_set()
129 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_get_direction()  local
135 	ret = regmap_read(pctl->stmfx->map, reg, &val);  in stmfx_gpio_get_direction()
150 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_direction_input()  local
154 	return regmap_write_bits(pctl->stmfx->map, reg, mask, 0);  in stmfx_gpio_direction_input()
160 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gc);  in stmfx_gpio_direction_output()  local
166 	return regmap_write_bits(pctl->stmfx->map, reg, mask, mask);  in stmfx_gpio_direction_output()
169 static int stmfx_pinconf_get_pupd(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_get_pupd()  argument
176 	ret = regmap_read(pctl->stmfx->map, reg, &pupd);  in stmfx_pinconf_get_pupd()
183 static int stmfx_pinconf_set_pupd(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_set_pupd()  argument
189 	return regmap_write_bits(pctl->stmfx->map, reg, mask, pupd ? mask : 0);  in stmfx_pinconf_set_pupd()
192 static int stmfx_pinconf_get_type(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_get_type()  argument
199 	ret = regmap_read(pctl->stmfx->map, reg, &type);  in stmfx_pinconf_get_type()
206 static int stmfx_pinconf_set_type(struct stmfx_pinctrl *pctl,  in stmfx_pinconf_set_type()  argument
212 	return regmap_write_bits(pctl->stmfx->map, reg, mask, type ? mask : 0);  in stmfx_pinconf_set_type()
218 	struct stmfx_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in stmfx_pinconf_get()  local
228 	dir = stmfx_gpio_get_direction(&pctl->gpio_chip, pin);  in stmfx_pinconf_get()
238 	type = stmfx_pinconf_get_type(pctl, pin);  in stmfx_pinconf_get()
241 	pupd = stmfx_pinconf_get_pupd(pctl, pin);  in stmfx_pinconf_get()
270 		ret = stmfx_gpio_get(&pctl->gpio_chip, pin);  in stmfx_pinconf_get()
288 	struct stmfx_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in stmfx_pinconf_set()  local
308 			ret = stmfx_pinconf_set_type(pctl, pin, 0);  in stmfx_pinconf_set()
313 			ret = stmfx_pinconf_set_type(pctl, pin, 1);  in stmfx_pinconf_set()
316 			ret = stmfx_pinconf_set_pupd(pctl, pin, 0);  in stmfx_pinconf_set()
321 			ret = stmfx_pinconf_set_type(pctl, pin, 1);  in stmfx_pinconf_set()
324 			ret = stmfx_pinconf_set_pupd(pctl, pin, 1);  in stmfx_pinconf_set()
329 			ret = stmfx_pinconf_set_type(pctl, pin, 1);  in stmfx_pinconf_set()
334 			ret = stmfx_gpio_direction_output(&pctl->gpio_chip,  in stmfx_pinconf_set()
350 	struct stmfx_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in stmfx_pinconf_dbg_show()  local
358 	dir = stmfx_gpio_get_direction(&pctl->gpio_chip, offset);  in stmfx_pinconf_dbg_show()
361 	type = stmfx_pinconf_get_type(pctl, offset);  in stmfx_pinconf_dbg_show()
364 	pupd = stmfx_pinconf_get_pupd(pctl, offset);  in stmfx_pinconf_dbg_show()
367 	val = stmfx_gpio_get(&pctl->gpio_chip, offset);  in stmfx_pinconf_dbg_show()
424 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_mask()  local
428 	pctl->irq_gpi_src[reg] &= ~mask;  in stmfx_pinctrl_irq_mask()
435 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_unmask()  local
440 	pctl->irq_gpi_src[reg] |= mask;  in stmfx_pinctrl_irq_unmask()
446 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_set_type()  local
454 		pctl->irq_gpi_evt[reg] |= mask;  in stmfx_pinctrl_irq_set_type()
457 		pctl->irq_gpi_evt[reg] &= ~mask;  in stmfx_pinctrl_irq_set_type()
462 		pctl->irq_gpi_type[reg] |= mask;  in stmfx_pinctrl_irq_set_type()
464 		pctl->irq_gpi_type[reg] &= ~mask;  in stmfx_pinctrl_irq_set_type()
474 		pctl->irq_toggle_edge[reg] |= mask;  in stmfx_pinctrl_irq_set_type()
476 		pctl->irq_toggle_edge[reg] &= mask;  in stmfx_pinctrl_irq_set_type()
484 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_bus_lock()  local
486 	mutex_lock(&pctl->lock);  in stmfx_pinctrl_irq_bus_lock()
492 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_bus_sync_unlock()  local
501 	if (pctl->irq_toggle_edge[reg] & mask) {  in stmfx_pinctrl_irq_bus_sync_unlock()
503 			pctl->irq_gpi_type[reg] &= ~mask;  in stmfx_pinctrl_irq_bus_sync_unlock()
505 			pctl->irq_gpi_type[reg] |= mask;  in stmfx_pinctrl_irq_bus_sync_unlock()
508 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_EVT,  in stmfx_pinctrl_irq_bus_sync_unlock()
509 			  pctl->irq_gpi_evt, NR_GPIO_REGS);  in stmfx_pinctrl_irq_bus_sync_unlock()
510 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_TYPE,  in stmfx_pinctrl_irq_bus_sync_unlock()
511 			  pctl->irq_gpi_type, NR_GPIO_REGS);  in stmfx_pinctrl_irq_bus_sync_unlock()
512 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_irq_bus_sync_unlock()
513 			  pctl->irq_gpi_src, NR_GPIO_REGS);  in stmfx_pinctrl_irq_bus_sync_unlock()
515 	mutex_unlock(&pctl->lock);  in stmfx_pinctrl_irq_bus_sync_unlock()
537 static void stmfx_pinctrl_irq_toggle_trigger(struct stmfx_pinctrl *pctl,  in stmfx_pinctrl_irq_toggle_trigger()  argument
544 	if (!(pctl->irq_toggle_edge[reg] & mask))  in stmfx_pinctrl_irq_toggle_trigger()
547 	val = stmfx_gpio_get(&pctl->gpio_chip, offset);  in stmfx_pinctrl_irq_toggle_trigger()
552 		pctl->irq_gpi_type[reg] &= mask;  in stmfx_pinctrl_irq_toggle_trigger()
553 		regmap_write_bits(pctl->stmfx->map,  in stmfx_pinctrl_irq_toggle_trigger()
558 		pctl->irq_gpi_type[reg] |= mask;  in stmfx_pinctrl_irq_toggle_trigger()
559 		regmap_write_bits(pctl->stmfx->map,  in stmfx_pinctrl_irq_toggle_trigger()
567 	struct stmfx_pinctrl *pctl = (struct stmfx_pinctrl *)dev_id;  in stmfx_pinctrl_irq_thread_fn()  local
568 	struct gpio_chip *gc = &pctl->gpio_chip;  in stmfx_pinctrl_irq_thread_fn()
574 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_IRQ_GPI_PENDING,  in stmfx_pinctrl_irq_thread_fn()
579 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_irq_thread_fn()
587 		stmfx_pinctrl_irq_toggle_trigger(pctl, n);  in stmfx_pinctrl_irq_thread_fn()
590 	regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_irq_thread_fn()
591 			  pctl->irq_gpi_src, NR_GPIO_REGS);  in stmfx_pinctrl_irq_thread_fn()
599 	struct stmfx_pinctrl *pctl = gpiochip_get_data(gpio_chip);  in stmfx_pinctrl_irq_print_chip()  local
601 	seq_printf(p, dev_name(pctl->dev));  in stmfx_pinctrl_irq_print_chip()
616 static int stmfx_pinctrl_gpio_function_enable(struct stmfx_pinctrl *pctl)  in stmfx_pinctrl_gpio_function_enable()  argument
619 	struct pinctrl_dev *pctl_dev = pctl->pctl_dev;  in stmfx_pinctrl_gpio_function_enable()
622 	pctl->gpio_valid_mask = GENMASK(15, 0);  in stmfx_pinctrl_gpio_function_enable()
627 		pctl->gpio_valid_mask |= GENMASK(19, 16);  in stmfx_pinctrl_gpio_function_enable()
633 		pctl->gpio_valid_mask |= GENMASK(23, 20);  in stmfx_pinctrl_gpio_function_enable()
636 	return stmfx_function_enable(pctl->stmfx, func);  in stmfx_pinctrl_gpio_function_enable()
643 	struct stmfx_pinctrl *pctl;  in stmfx_pinctrl_probe()  local
647 	pctl = devm_kzalloc(stmfx->dev, sizeof(*pctl), GFP_KERNEL);  in stmfx_pinctrl_probe()
648 	if (!pctl)  in stmfx_pinctrl_probe()
651 	platform_set_drvdata(pdev, pctl);  in stmfx_pinctrl_probe()
653 	pctl->dev = &pdev->dev;  in stmfx_pinctrl_probe()
654 	pctl->stmfx = stmfx;  in stmfx_pinctrl_probe()
657 		dev_err(pctl->dev, "missing required gpio-ranges property\n");  in stmfx_pinctrl_probe()
665 	mutex_init(&pctl->lock);  in stmfx_pinctrl_probe()
668 	pctl->pctl_desc.name = "stmfx-pinctrl";  in stmfx_pinctrl_probe()
669 	pctl->pctl_desc.pctlops = &stmfx_pinctrl_ops;  in stmfx_pinctrl_probe()
670 	pctl->pctl_desc.confops = &stmfx_pinconf_ops;  in stmfx_pinctrl_probe()
671 	pctl->pctl_desc.pins = stmfx_pins;  in stmfx_pinctrl_probe()
672 	pctl->pctl_desc.npins = ARRAY_SIZE(stmfx_pins);  in stmfx_pinctrl_probe()
673 	pctl->pctl_desc.owner = THIS_MODULE;  in stmfx_pinctrl_probe()
674 	pctl->pctl_desc.link_consumers = true;  in stmfx_pinctrl_probe()
676 	ret = devm_pinctrl_register_and_init(pctl->dev, &pctl->pctl_desc,  in stmfx_pinctrl_probe()
677 					     pctl, &pctl->pctl_dev);  in stmfx_pinctrl_probe()
679 		dev_err(pctl->dev, "pinctrl registration failed\n");  in stmfx_pinctrl_probe()
683 	ret = pinctrl_enable(pctl->pctl_dev);  in stmfx_pinctrl_probe()
685 		dev_err(pctl->dev, "pinctrl enable failed\n");  in stmfx_pinctrl_probe()
690 	pctl->gpio_chip.label = "stmfx-gpio";  in stmfx_pinctrl_probe()
691 	pctl->gpio_chip.parent = pctl->dev;  in stmfx_pinctrl_probe()
692 	pctl->gpio_chip.get_direction = stmfx_gpio_get_direction;  in stmfx_pinctrl_probe()
693 	pctl->gpio_chip.direction_input = stmfx_gpio_direction_input;  in stmfx_pinctrl_probe()
694 	pctl->gpio_chip.direction_output = stmfx_gpio_direction_output;  in stmfx_pinctrl_probe()
695 	pctl->gpio_chip.get = stmfx_gpio_get;  in stmfx_pinctrl_probe()
696 	pctl->gpio_chip.set = stmfx_gpio_set;  in stmfx_pinctrl_probe()
697 	pctl->gpio_chip.set_config = gpiochip_generic_config;  in stmfx_pinctrl_probe()
698 	pctl->gpio_chip.base = -1;  in stmfx_pinctrl_probe()
699 	pctl->gpio_chip.ngpio = pctl->pctl_desc.npins;  in stmfx_pinctrl_probe()
700 	pctl->gpio_chip.can_sleep = true;  in stmfx_pinctrl_probe()
702 	girq = &pctl->gpio_chip.irq;  in stmfx_pinctrl_probe()
712 	ret = devm_gpiochip_add_data(pctl->dev, &pctl->gpio_chip, pctl);  in stmfx_pinctrl_probe()
714 		dev_err(pctl->dev, "gpio_chip registration failed\n");  in stmfx_pinctrl_probe()
718 	ret = stmfx_pinctrl_gpio_function_enable(pctl);  in stmfx_pinctrl_probe()
722 	ret = devm_request_threaded_irq(pctl->dev, irq, NULL,  in stmfx_pinctrl_probe()
725 					dev_name(pctl->dev), pctl);  in stmfx_pinctrl_probe()
727 		dev_err(pctl->dev, "cannot request irq%d\n", irq);  in stmfx_pinctrl_probe()
731 	dev_info(pctl->dev,  in stmfx_pinctrl_probe()
732 		 "%ld GPIOs available\n", hweight_long(pctl->gpio_valid_mask));  in stmfx_pinctrl_probe()
748 static int stmfx_pinctrl_backup_regs(struct stmfx_pinctrl *pctl)  in stmfx_pinctrl_backup_regs()  argument
752 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_STATE,  in stmfx_pinctrl_backup_regs()
753 			       &pctl->bkp_gpio_state, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
756 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_DIR,  in stmfx_pinctrl_backup_regs()
757 			       &pctl->bkp_gpio_dir, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
760 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_TYPE,  in stmfx_pinctrl_backup_regs()
761 			       &pctl->bkp_gpio_type, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
764 	ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_PUPD,  in stmfx_pinctrl_backup_regs()
765 			       &pctl->bkp_gpio_pupd, NR_GPIO_REGS);  in stmfx_pinctrl_backup_regs()
772 static int stmfx_pinctrl_restore_regs(struct stmfx_pinctrl *pctl)  in stmfx_pinctrl_restore_regs()  argument
776 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_DIR,  in stmfx_pinctrl_restore_regs()
777 				pctl->bkp_gpio_dir, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
780 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_TYPE,  in stmfx_pinctrl_restore_regs()
781 				pctl->bkp_gpio_type, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
784 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_PUPD,  in stmfx_pinctrl_restore_regs()
785 				pctl->bkp_gpio_pupd, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
788 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPO_SET,  in stmfx_pinctrl_restore_regs()
789 				pctl->bkp_gpio_state, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
792 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_EVT,  in stmfx_pinctrl_restore_regs()
793 				pctl->irq_gpi_evt, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
796 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_TYPE,  in stmfx_pinctrl_restore_regs()
797 				pctl->irq_gpi_type, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
800 	ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC,  in stmfx_pinctrl_restore_regs()
801 				pctl->irq_gpi_src, NR_GPIO_REGS);  in stmfx_pinctrl_restore_regs()
810 	struct stmfx_pinctrl *pctl = dev_get_drvdata(dev);  in stmfx_pinctrl_suspend()  local
813 	ret = stmfx_pinctrl_backup_regs(pctl);  in stmfx_pinctrl_suspend()
815 		dev_err(pctl->dev, "registers backup failure\n");  in stmfx_pinctrl_suspend()
824 	struct stmfx_pinctrl *pctl = dev_get_drvdata(dev);  in stmfx_pinctrl_resume()  local
827 	ret = stmfx_pinctrl_restore_regs(pctl);  in stmfx_pinctrl_resume()
829 		dev_err(pctl->dev, "registers restoration failure\n");  in stmfx_pinctrl_resume()