Lines Matching full:pctl
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()
584 stmfx_pinctrl_irq_toggle_trigger(pctl, n); in stmfx_pinctrl_irq_thread_fn()
587 regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC, in stmfx_pinctrl_irq_thread_fn()
588 pctl->irq_gpi_src, NR_GPIO_REGS); in stmfx_pinctrl_irq_thread_fn()
593 static int stmfx_pinctrl_gpio_function_enable(struct stmfx_pinctrl *pctl) in stmfx_pinctrl_gpio_function_enable() argument
596 struct pinctrl_dev *pctl_dev = pctl->pctl_dev; in stmfx_pinctrl_gpio_function_enable()
599 pctl->gpio_valid_mask = GENMASK(15, 0); in stmfx_pinctrl_gpio_function_enable()
604 pctl->gpio_valid_mask |= GENMASK(19, 16); in stmfx_pinctrl_gpio_function_enable()
610 pctl->gpio_valid_mask |= GENMASK(23, 20); in stmfx_pinctrl_gpio_function_enable()
613 return stmfx_function_enable(pctl->stmfx, func); in stmfx_pinctrl_gpio_function_enable()
620 struct stmfx_pinctrl *pctl; in stmfx_pinctrl_probe() local
624 pctl = devm_kzalloc(stmfx->dev, sizeof(*pctl), GFP_KERNEL); in stmfx_pinctrl_probe()
625 if (!pctl) in stmfx_pinctrl_probe()
628 platform_set_drvdata(pdev, pctl); in stmfx_pinctrl_probe()
630 pctl->dev = &pdev->dev; in stmfx_pinctrl_probe()
631 pctl->stmfx = stmfx; in stmfx_pinctrl_probe()
634 dev_err(pctl->dev, "missing required gpio-ranges property\n"); in stmfx_pinctrl_probe()
642 mutex_init(&pctl->lock); in stmfx_pinctrl_probe()
645 pctl->pctl_desc.name = "stmfx-pinctrl"; in stmfx_pinctrl_probe()
646 pctl->pctl_desc.pctlops = &stmfx_pinctrl_ops; in stmfx_pinctrl_probe()
647 pctl->pctl_desc.confops = &stmfx_pinconf_ops; in stmfx_pinctrl_probe()
648 pctl->pctl_desc.pins = stmfx_pins; in stmfx_pinctrl_probe()
649 pctl->pctl_desc.npins = ARRAY_SIZE(stmfx_pins); in stmfx_pinctrl_probe()
650 pctl->pctl_desc.owner = THIS_MODULE; in stmfx_pinctrl_probe()
651 pctl->pctl_desc.link_consumers = true; in stmfx_pinctrl_probe()
653 ret = devm_pinctrl_register_and_init(pctl->dev, &pctl->pctl_desc, in stmfx_pinctrl_probe()
654 pctl, &pctl->pctl_dev); in stmfx_pinctrl_probe()
656 dev_err(pctl->dev, "pinctrl registration failed\n"); in stmfx_pinctrl_probe()
660 ret = pinctrl_enable(pctl->pctl_dev); in stmfx_pinctrl_probe()
662 dev_err(pctl->dev, "pinctrl enable failed\n"); in stmfx_pinctrl_probe()
667 pctl->gpio_chip.label = "stmfx-gpio"; in stmfx_pinctrl_probe()
668 pctl->gpio_chip.parent = pctl->dev; in stmfx_pinctrl_probe()
669 pctl->gpio_chip.get_direction = stmfx_gpio_get_direction; in stmfx_pinctrl_probe()
670 pctl->gpio_chip.direction_input = stmfx_gpio_direction_input; in stmfx_pinctrl_probe()
671 pctl->gpio_chip.direction_output = stmfx_gpio_direction_output; in stmfx_pinctrl_probe()
672 pctl->gpio_chip.get = stmfx_gpio_get; in stmfx_pinctrl_probe()
673 pctl->gpio_chip.set = stmfx_gpio_set; in stmfx_pinctrl_probe()
674 pctl->gpio_chip.set_config = gpiochip_generic_config; in stmfx_pinctrl_probe()
675 pctl->gpio_chip.base = -1; in stmfx_pinctrl_probe()
676 pctl->gpio_chip.ngpio = pctl->pctl_desc.npins; in stmfx_pinctrl_probe()
677 pctl->gpio_chip.can_sleep = true; in stmfx_pinctrl_probe()
678 pctl->gpio_chip.of_node = np; in stmfx_pinctrl_probe()
680 pctl->irq_chip.name = dev_name(pctl->dev); in stmfx_pinctrl_probe()
681 pctl->irq_chip.irq_mask = stmfx_pinctrl_irq_mask; in stmfx_pinctrl_probe()
682 pctl->irq_chip.irq_unmask = stmfx_pinctrl_irq_unmask; in stmfx_pinctrl_probe()
683 pctl->irq_chip.irq_set_type = stmfx_pinctrl_irq_set_type; in stmfx_pinctrl_probe()
684 pctl->irq_chip.irq_bus_lock = stmfx_pinctrl_irq_bus_lock; in stmfx_pinctrl_probe()
685 pctl->irq_chip.irq_bus_sync_unlock = stmfx_pinctrl_irq_bus_sync_unlock; in stmfx_pinctrl_probe()
686 pctl->irq_chip.irq_request_resources = stmfx_gpio_irq_request_resources; in stmfx_pinctrl_probe()
687 pctl->irq_chip.irq_release_resources = stmfx_gpio_irq_release_resources; in stmfx_pinctrl_probe()
689 girq = &pctl->gpio_chip.irq; in stmfx_pinctrl_probe()
690 girq->chip = &pctl->irq_chip; in stmfx_pinctrl_probe()
699 ret = devm_gpiochip_add_data(pctl->dev, &pctl->gpio_chip, pctl); in stmfx_pinctrl_probe()
701 dev_err(pctl->dev, "gpio_chip registration failed\n"); in stmfx_pinctrl_probe()
705 ret = stmfx_pinctrl_gpio_function_enable(pctl); in stmfx_pinctrl_probe()
709 ret = devm_request_threaded_irq(pctl->dev, irq, NULL, in stmfx_pinctrl_probe()
712 pctl->irq_chip.name, pctl); in stmfx_pinctrl_probe()
714 dev_err(pctl->dev, "cannot request irq%d\n", irq); in stmfx_pinctrl_probe()
718 dev_info(pctl->dev, in stmfx_pinctrl_probe()
719 "%ld GPIOs available\n", hweight_long(pctl->gpio_valid_mask)); in stmfx_pinctrl_probe()
735 static int stmfx_pinctrl_backup_regs(struct stmfx_pinctrl *pctl) in stmfx_pinctrl_backup_regs() argument
739 ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_STATE, in stmfx_pinctrl_backup_regs()
740 &pctl->bkp_gpio_state, NR_GPIO_REGS); in stmfx_pinctrl_backup_regs()
743 ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_DIR, in stmfx_pinctrl_backup_regs()
744 &pctl->bkp_gpio_dir, NR_GPIO_REGS); in stmfx_pinctrl_backup_regs()
747 ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_TYPE, in stmfx_pinctrl_backup_regs()
748 &pctl->bkp_gpio_type, NR_GPIO_REGS); in stmfx_pinctrl_backup_regs()
751 ret = regmap_bulk_read(pctl->stmfx->map, STMFX_REG_GPIO_PUPD, in stmfx_pinctrl_backup_regs()
752 &pctl->bkp_gpio_pupd, NR_GPIO_REGS); in stmfx_pinctrl_backup_regs()
759 static int stmfx_pinctrl_restore_regs(struct stmfx_pinctrl *pctl) in stmfx_pinctrl_restore_regs() argument
763 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_DIR, in stmfx_pinctrl_restore_regs()
764 pctl->bkp_gpio_dir, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
767 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_TYPE, in stmfx_pinctrl_restore_regs()
768 pctl->bkp_gpio_type, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
771 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPIO_PUPD, in stmfx_pinctrl_restore_regs()
772 pctl->bkp_gpio_pupd, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
775 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_GPO_SET, in stmfx_pinctrl_restore_regs()
776 pctl->bkp_gpio_state, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
779 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_EVT, in stmfx_pinctrl_restore_regs()
780 pctl->irq_gpi_evt, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
783 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_TYPE, in stmfx_pinctrl_restore_regs()
784 pctl->irq_gpi_type, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
787 ret = regmap_bulk_write(pctl->stmfx->map, STMFX_REG_IRQ_GPI_SRC, in stmfx_pinctrl_restore_regs()
788 pctl->irq_gpi_src, NR_GPIO_REGS); in stmfx_pinctrl_restore_regs()
797 struct stmfx_pinctrl *pctl = dev_get_drvdata(dev); in stmfx_pinctrl_suspend() local
800 ret = stmfx_pinctrl_backup_regs(pctl); in stmfx_pinctrl_suspend()
802 dev_err(pctl->dev, "registers backup failure\n"); in stmfx_pinctrl_suspend()
811 struct stmfx_pinctrl *pctl = dev_get_drvdata(dev); in stmfx_pinctrl_resume() local
814 ret = stmfx_pinctrl_restore_regs(pctl); in stmfx_pinctrl_resume()
816 dev_err(pctl->dev, "registers restoration failure\n"); in stmfx_pinctrl_resume()