Lines Matching refs:pctl
210 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_gpio_request() local
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()
356 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_gpio_irq_request_resources() local
365 dev_err(pctl->dev, "unable to lock HW IRQ %lu for IRQ\n", in stm32_gpio_irq_request_resources()
416 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_gpio_domain_activate() local
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()
443 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_gpio_domain_alloc() local
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()
458 pctl->irqmux_map |= BIT(hwirq); in stm32_gpio_domain_alloc()
461 spin_unlock_irqrestore(&pctl->irqmux_lock, flags); in stm32_gpio_domain_alloc()
480 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_gpio_domain_free() local
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()
500 stm32_pctrl_find_group_by_pin(struct stm32_pinctrl *pctl, u32 pin) in stm32_pctrl_find_group_by_pin() argument
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()
514 static bool stm32_pctrl_is_function_valid(struct stm32_pinctrl *pctl, in stm32_pctrl_is_function_valid() argument
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()
535 dev_err(pctl->dev, "invalid function %d on pin %d .\n", fnum, pin_num); in stm32_pctrl_is_function_valid()
540 static int stm32_pctrl_dt_node_to_map_func(struct stm32_pinctrl *pctl, in stm32_pctrl_dt_node_to_map_func() argument
551 if (!stm32_pctrl_is_function_valid(pctl, pin, fnum)) in stm32_pctrl_dt_node_to_map_func()
566 struct stm32_pinctrl *pctl; in stm32_pctrl_dt_subnode_to_map() local
576 pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pctrl_dt_subnode_to_map()
580 dev_err(pctl->dev, "missing pins property in node %pOFn .\n", in stm32_pctrl_dt_subnode_to_map()
622 if (!stm32_pctrl_is_function_valid(pctl, pin, func)) { in stm32_pctrl_dt_subnode_to_map()
627 grp = stm32_pctrl_find_group_by_pin(pctl, pin); 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()
635 err = stm32_pctrl_dt_node_to_map_func(pctl, pin, func, grp, map, in stm32_pctrl_dt_subnode_to_map()
682 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pctrl_get_groups_count() local
684 return pctl->ngroups; in stm32_pctrl_get_groups_count()
690 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pctrl_get_group_name() local
692 return pctl->groups[group].name; in stm32_pctrl_get_group_name()
700 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pctrl_get_group_pins() local
702 *pins = (unsigned *)&pctl->groups[group].pin; in stm32_pctrl_get_group_pins()
735 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pmx_get_func_groups() local
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() local
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()
775 if (pctl->hwlock) in stm32_pmx_set_mode()
776 hwspin_unlock_in_atomic(pctl->hwlock); in stm32_pmx_set_mode()
815 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pmx_set_mux() local
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()
828 dev_err(pctl->dev, "No gpio range defined.\n"); in stm32_pmx_set_mux()
865 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_pconf_set_driving() local
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()
887 if (pctl->hwlock) in stm32_pconf_set_driving()
888 hwspin_unlock_in_atomic(pctl->hwlock); in stm32_pconf_set_driving()
920 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_pconf_set_speed() local
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()
942 if (pctl->hwlock) in stm32_pconf_set_speed()
943 hwspin_unlock_in_atomic(pctl->hwlock); in stm32_pconf_set_speed()
975 struct stm32_pinctrl *pctl = dev_get_drvdata(bank->gpio_chip.parent); in stm32_pconf_set_bias() local
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()
997 if (pctl->hwlock) in stm32_pconf_set_bias()
998 hwspin_unlock_in_atomic(pctl->hwlock); in stm32_pconf_set_bias()
1053 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pconf_parse_conf() local
1060 dev_err(pctl->dev, "No gpio range defined.\n"); in stm32_pconf_parse_conf()
1101 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pconf_group_get() local
1103 *config = pctl->groups[group].config; in stm32_pconf_group_get()
1111 struct stm32_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); in stm32_pconf_group_set() local
1112 struct stm32_pinctrl_group *g = &pctl->groups[group]; in stm32_pconf_group_set()
1218 static int stm32_gpiolib_register_bank(struct stm32_pinctrl *pctl, in stm32_gpiolib_register_bank() argument
1221 struct stm32_gpio_bank *bank = &pctl->banks[pctl->nbanks]; in stm32_gpiolib_register_bank()
1225 struct device *dev = pctl->dev; in stm32_gpiolib_register_bank()
1259 bank_nr = pctl->nbanks; 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()
1286 bank->domain = irq_domain_create_hierarchy(pctl->domain, 0, in stm32_gpiolib_register_bank()
1324 struct stm32_pinctrl *pctl) in stm32_pctrl_dt_setup_irq() argument
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()
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()
1368 struct stm32_pinctrl *pctl = platform_get_drvdata(pdev); in stm32_pctrl_build_state() local
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()
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()
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()
1391 pctl->grp_names[i] = pin->pin.name; in stm32_pctrl_build_state()
1397 static int stm32_pctrl_create_pins_tab(struct stm32_pinctrl *pctl, in stm32_pctrl_create_pins_tab() argument
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()
1413 pctl->npins = nb_pins_available; in stm32_pctrl_create_pins_tab()
1424 struct stm32_pinctrl *pctl; in stm32_pctl_probe() local
1440 pctl = devm_kzalloc(dev, sizeof(*pctl), GFP_KERNEL); in stm32_pctl_probe()
1441 if (!pctl) in stm32_pctl_probe()
1444 platform_set_drvdata(pdev, pctl); in stm32_pctl_probe()
1447 pctl->domain = stm32_pctrl_get_irq_domain(np); in stm32_pctl_probe()
1448 if (IS_ERR(pctl->domain)) in stm32_pctl_probe()
1449 return PTR_ERR(pctl->domain); in stm32_pctl_probe()
1457 pctl->hwlock = hwspin_lock_request_specific(hwlock_id); in stm32_pctl_probe()
1460 spin_lock_init(&pctl->irqmux_lock); in stm32_pctl_probe()
1462 pctl->dev = dev; in stm32_pctl_probe()
1463 pctl->match_data = match->data; in stm32_pctl_probe()
1466 if (!of_property_read_u32(np, "st,package", &pctl->pkg)) in stm32_pctl_probe()
1467 dev_dbg(pctl->dev, "package detected: %x\n", pctl->pkg); in stm32_pctl_probe()
1469 pctl->pins = devm_kcalloc(pctl->dev, pctl->match_data->npins, in stm32_pctl_probe()
1470 sizeof(*pctl->pins), GFP_KERNEL); in stm32_pctl_probe()
1471 if (!pctl->pins) in stm32_pctl_probe()
1474 ret = stm32_pctrl_create_pins_tab(pctl, pctl->pins); in stm32_pctl_probe()
1484 if (pctl->domain) { in stm32_pctl_probe()
1485 ret = stm32_pctrl_dt_setup_irq(pdev, pctl); in stm32_pctl_probe()
1490 pins = devm_kcalloc(&pdev->dev, pctl->npins, sizeof(*pins), in stm32_pctl_probe()
1495 for (i = 0; i < pctl->npins; i++) in stm32_pctl_probe()
1496 pins[i] = pctl->pins[i].pin; in stm32_pctl_probe()
1498 pctl->pctl_desc.name = dev_name(&pdev->dev); in stm32_pctl_probe()
1499 pctl->pctl_desc.owner = THIS_MODULE; in stm32_pctl_probe()
1500 pctl->pctl_desc.pins = pins; in stm32_pctl_probe()
1501 pctl->pctl_desc.npins = pctl->npins; in stm32_pctl_probe()
1502 pctl->pctl_desc.link_consumers = true; in stm32_pctl_probe()
1503 pctl->pctl_desc.confops = &stm32_pconf_ops; in stm32_pctl_probe()
1504 pctl->pctl_desc.pctlops = &stm32_pctrl_ops; in stm32_pctl_probe()
1505 pctl->pctl_desc.pmxops = &stm32_pmx_ops; in stm32_pctl_probe()
1506 pctl->dev = &pdev->dev; in stm32_pctl_probe()
1508 pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->pctl_desc, in stm32_pctl_probe()
1509 pctl); in stm32_pctl_probe()
1511 if (IS_ERR(pctl->pctl_dev)) { in stm32_pctl_probe()
1513 return PTR_ERR(pctl->pctl_dev); in stm32_pctl_probe()
1524 pctl->banks = devm_kcalloc(dev, banks, sizeof(*pctl->banks), in stm32_pctl_probe()
1526 if (!pctl->banks) in stm32_pctl_probe()
1531 struct stm32_gpio_bank *bank = &pctl->banks[i]; in stm32_pctl_probe()
1556 ret = stm32_gpiolib_register_bank(pctl, child); in stm32_pctl_probe()
1562 pctl->nbanks++; in stm32_pctl_probe()
1572 struct stm32_pinctrl *pctl, u32 pin) in stm32_pinctrl_restore_gpio_regs() argument
1574 const struct pin_desc *desc = pin_desc_get(pctl->pctl_dev, pin); in stm32_pinctrl_restore_gpio_regs()
1581 range = pinctrl_find_gpio_range_from_pin(pctl->pctl_dev, pin); in stm32_pinctrl_restore_gpio_regs()
1626 regmap_field_write(pctl->irqmux[offset], bank->bank_ioport_nr); in stm32_pinctrl_restore_gpio_regs()
1633 struct stm32_pinctrl *pctl = dev_get_drvdata(dev); in stm32_pinctrl_resume() local
1634 struct stm32_pinctrl_group *g = pctl->groups; in stm32_pinctrl_resume()
1637 for (i = 0; i < pctl->ngroups; i++, g++) in stm32_pinctrl_resume()
1638 stm32_pinctrl_restore_gpio_regs(pctl, g->pin); in stm32_pinctrl_resume()