pinctrl/meson/pinctrl-meson.c

66  * @pc:		the pinctrl instance
72 static int meson_get_bank(struct meson_pinctrl *pc, unsigned int pin,
77 	for (i = 0; i < pc->data->num_banks; i++) {
78 		if (pin >= pc->data->banks[i].first &&
79 		    pin <= pc->data->banks[i].last) {
80 			*bank = &pc->data->banks[i];
110 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
112 	return pc->data->num_groups;
118 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
120 	return pc->data->groups[selector].name;
126 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
128 	*pins = pc->data->groups[selector].pins;
129 	*num_pins = pc->data->groups[selector].num_pins;
151 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
153 	return pc->data->num_funcs;
160 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
162 	return pc->data->funcs[selector].name;
170 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
172 	*groups = pc->data->funcs[selector].groups;
173 	*num_groups = pc->data->funcs[selector].num_groups;
179 static int meson_pinconf_set_gpio_bit(struct meson_pinctrl *pc,
188 	ret = meson_get_bank(pc, pin, &bank);
193 	return regmap_update_bits(pc->reg_gpio, reg, BIT(bit),
197 static int meson_pinconf_get_gpio_bit(struct meson_pinctrl *pc,
205 	ret = meson_get_bank(pc, pin, &bank);
210 	ret = regmap_read(pc->reg_gpio, reg, &val);
217 static int meson_pinconf_set_output(struct meson_pinctrl *pc,
221 	return meson_pinconf_set_gpio_bit(pc, pin, MESON_REG_DIR, !out);
224 static int meson_pinconf_get_output(struct meson_pinctrl *pc,
227 	int ret = meson_pinconf_get_gpio_bit(pc, pin, MESON_REG_DIR);
235 static int meson_pinconf_set_drive(struct meson_pinctrl *pc,
239 	return meson_pinconf_set_gpio_bit(pc, pin, MESON_REG_OUT, high);
242 static int meson_pinconf_get_drive(struct meson_pinctrl *pc,
245 	return meson_pinconf_get_gpio_bit(pc, pin, MESON_REG_OUT);
248 static int meson_pinconf_set_output_drive(struct meson_pinctrl *pc,
254 	ret = meson_pinconf_set_output(pc, pin, true);
258 	return meson_pinconf_set_drive(pc, pin, high);
261 static int meson_pinconf_disable_bias(struct meson_pinctrl *pc,
268 	ret = meson_get_bank(pc, pin, &bank);
273 	ret = regmap_update_bits(pc->reg_pullen, reg, BIT(bit), 0);
280 static int meson_pinconf_enable_bias(struct meson_pinctrl *pc, unsigned int pin,
287 	ret = meson_get_bank(pc, pin, &bank);
295 	ret = regmap_update_bits(pc->reg_pull, reg, BIT(bit), val);
300 	ret = regmap_update_bits(pc->reg_pullen, reg, BIT(bit),	BIT(bit));
307 static int meson_pinconf_set_drive_strength(struct meson_pinctrl *pc,
315 	if (!pc->reg_ds) {
316 		dev_err(pc->dev, "drive-strength not supported\n");
320 	ret = meson_get_bank(pc, pin, &bank);
335 		dev_warn_once(pc->dev,
341 	ret = regmap_update_bits(pc->reg_ds, reg, 0x3 << bit, ds_val << bit);
351 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
372 			ret = meson_pinconf_disable_bias(pc, pin);
375 			ret = meson_pinconf_enable_bias(pc, pin, true);
378 			ret = meson_pinconf_enable_bias(pc, pin, false);
381 			ret = meson_pinconf_set_drive_strength(pc, pin, arg);
384 			ret = meson_pinconf_set_output(pc, pin, arg);
387 			ret = meson_pinconf_set_output_drive(pc, pin, arg);
400 static int meson_pinconf_get_pull(struct meson_pinctrl *pc, unsigned int pin)
406 	ret = meson_get_bank(pc, pin, &bank);
412 	ret = regmap_read(pc->reg_pullen, reg, &val);
421 		ret = regmap_read(pc->reg_pull, reg, &val);
434 static int meson_pinconf_get_drive_strength(struct meson_pinctrl *pc,
443 	if (!pc->reg_ds)
446 	ret = meson_get_bank(pc, pin, &bank);
452 	ret = regmap_read(pc->reg_ds, reg, &val);
479 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
488 		if (meson_pinconf_get_pull(pc, pin) == param)
494 		ret = meson_pinconf_get_drive_strength(pc, pin, &arg);
499 		ret = meson_pinconf_get_output(pc, pin);
505 		ret = meson_pinconf_get_output(pc, pin);
509 		ret = meson_pinconf_get_drive(pc, pin);
521 	dev_dbg(pc->dev, "pinconf for pin %u is %lu\n", pin, *config);
530 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);
531 	struct meson_pmx_group *group = &pc->data->groups[num_group];
534 	dev_dbg(pc->dev, "set pinconf for group %s\n", group->name);
560 	struct meson_pinctrl *pc = gpiochip_get_data(chip);
563 	ret = meson_pinconf_get_output(pc, gpio);
589 	struct meson_pinctrl *pc = gpiochip_get_data(chip);
594 	ret = meson_get_bank(pc, gpio, &bank);
599 	regmap_read(pc->reg_gpio, reg, &val);
604 static int meson_gpiolib_register(struct meson_pinctrl *pc)
608 	pc->chip.label = pc->data->name;
609 	pc->chip.parent = pc->dev;
610 	pc->chip.fwnode = pc->fwnode;
611 	pc->chip.request = gpiochip_generic_request;
612 	pc->chip.free = gpiochip_generic_free;
613 	pc->chip.set_config = gpiochip_generic_config;
614 	pc->chip.get_direction = meson_gpio_get_direction;
615 	pc->chip.direction_input = meson_gpio_direction_input;
616 	pc->chip.direction_output = meson_gpio_direction_output;
617 	pc->chip.get = meson_gpio_get;
618 	pc->chip.set = meson_gpio_set;
619 	pc->chip.base = -1;
620 	pc->chip.ngpio = pc->data->num_pins;
621 	pc->chip.can_sleep = false;
623 	ret = gpiochip_add_data(&pc->chip, pc);
625 		dev_err(pc->dev, "can't add gpio chip %s\n",
626 			pc->data->name);
639 static struct regmap *meson_map_resource(struct meson_pinctrl *pc,
650 	base = devm_ioremap_resource(pc->dev, &res);
655 	meson_regmap_config.name = devm_kasprintf(pc->dev, GFP_KERNEL,
661 	return devm_regmap_init_mmio(pc->dev, base, &meson_regmap_config);
664 static int meson_pinctrl_parse_dt(struct meson_pinctrl *pc)
669 	chips = gpiochip_node_count(pc->dev);
671 		dev_err(pc->dev, "no gpio node found\n");
675 		dev_err(pc->dev, "multiple gpio nodes\n");
679 	pc->fwnode = gpiochip_node_get_first(pc->dev);
680 	gpio_np = to_of_node(pc->fwnode);
682 	pc->reg_mux = meson_map_resource(pc, gpio_np, "mux");
683 	if (IS_ERR_OR_NULL(pc->reg_mux)) {
684 		dev_err(pc->dev, "mux registers not found\n");
685 		return pc->reg_mux ? PTR_ERR(pc->reg_mux) : -ENOENT;
688 	pc->reg_gpio = meson_map_resource(pc, gpio_np, "gpio");
689 	if (IS_ERR_OR_NULL(pc->reg_gpio)) {
690 		dev_err(pc->dev, "gpio registers not found\n");
691 		return pc->reg_gpio ? PTR_ERR(pc->reg_gpio) : -ENOENT;
694 	pc->reg_pull = meson_map_resource(pc, gpio_np, "pull");
695 	if (IS_ERR(pc->reg_pull))
696 		pc->reg_pull = NULL;
698 	pc->reg_pullen = meson_map_resource(pc, gpio_np, "pull-enable");
699 	if (IS_ERR(pc->reg_pullen))
700 		pc->reg_pullen = NULL;
702 	pc->reg_ds = meson_map_resource(pc, gpio_np, "ds");
703 	if (IS_ERR(pc->reg_ds)) {
704 		dev_dbg(pc->dev, "ds registers not found - skipping\n");
705 		pc->reg_ds = NULL;
708 	if (pc->data->parse_dt)
709 		return pc->data->parse_dt(pc);
714 int meson8_aobus_parse_dt_extra(struct meson_pinctrl *pc)
716 	if (!pc->reg_pull)
719 	pc->reg_pullen = pc->reg_pull;
725 int meson_a1_parse_dt_extra(struct meson_pinctrl *pc)
727 	pc->reg_pull = pc->reg_gpio;
728 	pc->reg_pullen = pc->reg_gpio;
729 	pc->reg_ds = pc->reg_gpio;
738 	struct meson_pinctrl *pc;
741 	pc = devm_kzalloc(dev, sizeof(struct meson_pinctrl), GFP_KERNEL);
742 	if (!pc)
745 	pc->dev = dev;
746 	pc->data = (struct meson_pinctrl_data *) of_device_get_match_data(dev);
748 	ret = meson_pinctrl_parse_dt(pc);
752 	pc->desc.name		= "pinctrl-meson";
753 	pc->desc.owner		= THIS_MODULE;
754 	pc->desc.pctlops	= &meson_pctrl_ops;
755 	pc->desc.pmxops		= pc->data->pmx_ops;
756 	pc->desc.confops	= &meson_pinconf_ops;
757 	pc->desc.pins		= pc->data->pins;
758 	pc->desc.npins		= pc->data->num_pins;
760 	pc->pcdev = devm_pinctrl_register(pc->dev, &pc->desc, pc);
761 	if (IS_ERR(pc->pcdev)) {
762 		dev_err(pc->dev, "can't register pinctrl device");
763 		return PTR_ERR(pc->pcdev);
766 	return meson_gpiolib_register(pc);