68 static int meson_get_bank(struct meson_pinctrl *pc, unsigned int pin,  in meson_get_bank()  argument
73 	for (i = 0; i < pc->data->num_banks; i++) {  in meson_get_bank()
74 		if (pin >= pc->data->banks[i].first &&  in meson_get_bank()
75 		    pin <= pc->data->banks[i].last) {  in meson_get_bank()
76 			*bank = &pc->data->banks[i];  in meson_get_bank()
105 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_get_groups_count()  local
107 	return pc->data->num_groups;  in meson_get_groups_count()
113 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_get_group_name()  local
115 	return pc->data->groups[selector].name;  in meson_get_group_name()
121 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_get_group_pins()  local
123 	*pins = pc->data->groups[selector].pins;  in meson_get_group_pins()
124 	*num_pins = pc->data->groups[selector].num_pins;  in meson_get_group_pins()
146 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_pmx_get_funcs_count()  local
148 	return pc->data->num_funcs;  in meson_pmx_get_funcs_count()
154 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_pmx_get_func_name()  local
156 	return pc->data->funcs[selector].name;  in meson_pmx_get_func_name()
163 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_pmx_get_groups()  local
165 	*groups = pc->data->funcs[selector].groups;  in meson_pmx_get_groups()
166 	*num_groups = pc->data->funcs[selector].num_groups;  in meson_pmx_get_groups()
171 static int meson_pinconf_set_gpio_bit(struct meson_pinctrl *pc,  in meson_pinconf_set_gpio_bit()  argument
180 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_set_gpio_bit()
185 	return regmap_update_bits(pc->reg_gpio, reg, BIT(bit),  in meson_pinconf_set_gpio_bit()
189 static int meson_pinconf_get_gpio_bit(struct meson_pinctrl *pc,  in meson_pinconf_get_gpio_bit()  argument
197 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_get_gpio_bit()
202 	ret = regmap_read(pc->reg_gpio, reg, &val);  in meson_pinconf_get_gpio_bit()
209 static int meson_pinconf_set_output(struct meson_pinctrl *pc,  in meson_pinconf_set_output()  argument
213 	return meson_pinconf_set_gpio_bit(pc, pin, REG_DIR, !out);  in meson_pinconf_set_output()
216 static int meson_pinconf_get_output(struct meson_pinctrl *pc,  in meson_pinconf_get_output()  argument
219 	int ret = meson_pinconf_get_gpio_bit(pc, pin, REG_DIR);  in meson_pinconf_get_output()
227 static int meson_pinconf_set_drive(struct meson_pinctrl *pc,  in meson_pinconf_set_drive()  argument
231 	return meson_pinconf_set_gpio_bit(pc, pin, REG_OUT, high);  in meson_pinconf_set_drive()
234 static int meson_pinconf_get_drive(struct meson_pinctrl *pc,  in meson_pinconf_get_drive()  argument
237 	return meson_pinconf_get_gpio_bit(pc, pin, REG_OUT);  in meson_pinconf_get_drive()
240 static int meson_pinconf_set_output_drive(struct meson_pinctrl *pc,  in meson_pinconf_set_output_drive()  argument
246 	ret = meson_pinconf_set_output(pc, pin, true);  in meson_pinconf_set_output_drive()
250 	return meson_pinconf_set_drive(pc, pin, high);  in meson_pinconf_set_output_drive()
253 static int meson_pinconf_disable_bias(struct meson_pinctrl *pc,  in meson_pinconf_disable_bias()  argument
260 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_disable_bias()
265 	ret = regmap_update_bits(pc->reg_pullen, reg, BIT(bit), 0);  in meson_pinconf_disable_bias()
272 static int meson_pinconf_enable_bias(struct meson_pinctrl *pc, unsigned int pin,  in meson_pinconf_enable_bias()  argument
279 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_enable_bias()
287 	ret = regmap_update_bits(pc->reg_pull, reg, BIT(bit), val);  in meson_pinconf_enable_bias()
292 	ret = regmap_update_bits(pc->reg_pullen, reg, BIT(bit),	BIT(bit));  in meson_pinconf_enable_bias()
299 static int meson_pinconf_set_drive_strength(struct meson_pinctrl *pc,  in meson_pinconf_set_drive_strength()  argument
307 	if (!pc->reg_ds) {  in meson_pinconf_set_drive_strength()
308 		dev_err(pc->dev, "drive-strength not supported\n");  in meson_pinconf_set_drive_strength()
312 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_set_drive_strength()
328 		dev_warn_once(pc->dev,  in meson_pinconf_set_drive_strength()
334 	ret = regmap_update_bits(pc->reg_ds, reg, 0x3 << bit, ds_val << bit);  in meson_pinconf_set_drive_strength()
344 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_pinconf_set()  local
365 			ret = meson_pinconf_disable_bias(pc, pin);  in meson_pinconf_set()
368 			ret = meson_pinconf_enable_bias(pc, pin, true);  in meson_pinconf_set()
371 			ret = meson_pinconf_enable_bias(pc, pin, false);  in meson_pinconf_set()
374 			ret = meson_pinconf_set_drive_strength(pc, pin, arg);  in meson_pinconf_set()
377 			ret = meson_pinconf_set_output(pc, pin, arg);  in meson_pinconf_set()
380 			ret = meson_pinconf_set_output_drive(pc, pin, arg);  in meson_pinconf_set()
393 static int meson_pinconf_get_pull(struct meson_pinctrl *pc, unsigned int pin)  in meson_pinconf_get_pull()  argument
399 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_get_pull()
405 	ret = regmap_read(pc->reg_pullen, reg, &val);  in meson_pinconf_get_pull()
414 		ret = regmap_read(pc->reg_pull, reg, &val);  in meson_pinconf_get_pull()
427 static int meson_pinconf_get_drive_strength(struct meson_pinctrl *pc,  in meson_pinconf_get_drive_strength()  argument
436 	if (!pc->reg_ds)  in meson_pinconf_get_drive_strength()
439 	ret = meson_get_bank(pc, pin, &bank);  in meson_pinconf_get_drive_strength()
445 	ret = regmap_read(pc->reg_ds, reg, &val);  in meson_pinconf_get_drive_strength()
472 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_pinconf_get()  local
481 		if (meson_pinconf_get_pull(pc, pin) == param)  in meson_pinconf_get()
487 		ret = meson_pinconf_get_drive_strength(pc, pin, &arg);  in meson_pinconf_get()
492 		ret = meson_pinconf_get_output(pc, pin);  in meson_pinconf_get()
498 		ret = meson_pinconf_get_output(pc, pin);  in meson_pinconf_get()
502 		ret = meson_pinconf_get_drive(pc, pin);  in meson_pinconf_get()
514 	dev_dbg(pc->dev, "pinconf for pin %u is %lu\n", pin, *config);  in meson_pinconf_get()
523 	struct meson_pinctrl *pc = pinctrl_dev_get_drvdata(pcdev);  in meson_pinconf_group_set()  local
524 	struct meson_pmx_group *group = &pc->data->groups[num_group];  in meson_pinconf_group_set()
527 	dev_dbg(pc->dev, "set pinconf for group %s\n", group->name);  in meson_pinconf_group_set()
570 	struct meson_pinctrl *pc = gpiochip_get_data(chip);  in meson_gpio_get()  local
575 	ret = meson_get_bank(pc, gpio, &bank);  in meson_gpio_get()
580 	regmap_read(pc->reg_gpio, reg, &val);  in meson_gpio_get()
585 static int meson_gpiolib_register(struct meson_pinctrl *pc)  in meson_gpiolib_register()  argument
589 	pc->chip.label = pc->data->name;  in meson_gpiolib_register()
590 	pc->chip.parent = pc->dev;  in meson_gpiolib_register()
591 	pc->chip.request = gpiochip_generic_request;  in meson_gpiolib_register()
592 	pc->chip.free = gpiochip_generic_free;  in meson_gpiolib_register()
593 	pc->chip.direction_input = meson_gpio_direction_input;  in meson_gpiolib_register()
594 	pc->chip.direction_output = meson_gpio_direction_output;  in meson_gpiolib_register()
595 	pc->chip.get = meson_gpio_get;  in meson_gpiolib_register()
596 	pc->chip.set = meson_gpio_set;  in meson_gpiolib_register()
597 	pc->chip.base = -1;  in meson_gpiolib_register()
598 	pc->chip.ngpio = pc->data->num_pins;  in meson_gpiolib_register()
599 	pc->chip.can_sleep = false;  in meson_gpiolib_register()
600 	pc->chip.of_node = pc->of_node;  in meson_gpiolib_register()
601 	pc->chip.of_gpio_n_cells = 2;  in meson_gpiolib_register()
603 	ret = gpiochip_add_data(&pc->chip, pc);  in meson_gpiolib_register()
605 		dev_err(pc->dev, "can't add gpio chip %s\n",  in meson_gpiolib_register()
606 			pc->data->name);  in meson_gpiolib_register()
619 static struct regmap *meson_map_resource(struct meson_pinctrl *pc,  in meson_map_resource()  argument
630 	base = devm_ioremap_resource(pc->dev, &res);  in meson_map_resource()
635 	meson_regmap_config.name = devm_kasprintf(pc->dev, GFP_KERNEL,  in meson_map_resource()
641 	return devm_regmap_init_mmio(pc->dev, base, &meson_regmap_config);  in meson_map_resource()
644 static int meson_pinctrl_parse_dt(struct meson_pinctrl *pc,  in meson_pinctrl_parse_dt()  argument
653 			dev_err(pc->dev, "multiple gpio nodes\n");  in meson_pinctrl_parse_dt()
661 		dev_err(pc->dev, "no gpio node found\n");  in meson_pinctrl_parse_dt()
665 	pc->of_node = gpio_np;  in meson_pinctrl_parse_dt()
667 	pc->reg_mux = meson_map_resource(pc, gpio_np, "mux");  in meson_pinctrl_parse_dt()
668 	if (IS_ERR(pc->reg_mux)) {  in meson_pinctrl_parse_dt()
669 		dev_err(pc->dev, "mux registers not found\n");  in meson_pinctrl_parse_dt()
670 		return PTR_ERR(pc->reg_mux);  in meson_pinctrl_parse_dt()
673 	pc->reg_gpio = meson_map_resource(pc, gpio_np, "gpio");  in meson_pinctrl_parse_dt()
674 	if (IS_ERR(pc->reg_gpio)) {  in meson_pinctrl_parse_dt()
675 		dev_err(pc->dev, "gpio registers not found\n");  in meson_pinctrl_parse_dt()
676 		return PTR_ERR(pc->reg_gpio);  in meson_pinctrl_parse_dt()
679 	pc->reg_pull = meson_map_resource(pc, gpio_np, "pull");  in meson_pinctrl_parse_dt()
681 	if (IS_ERR(pc->reg_pull))  in meson_pinctrl_parse_dt()
682 		pc->reg_pull = pc->reg_gpio;  in meson_pinctrl_parse_dt()
684 	pc->reg_pullen = meson_map_resource(pc, gpio_np, "pull-enable");  in meson_pinctrl_parse_dt()
686 	if (IS_ERR(pc->reg_pullen))  in meson_pinctrl_parse_dt()
687 		pc->reg_pullen = pc->reg_pull;  in meson_pinctrl_parse_dt()
689 	pc->reg_ds = meson_map_resource(pc, gpio_np, "ds");  in meson_pinctrl_parse_dt()
690 	if (IS_ERR(pc->reg_ds)) {  in meson_pinctrl_parse_dt()
691 		dev_dbg(pc->dev, "ds registers not found - skipping\n");  in meson_pinctrl_parse_dt()
692 		pc->reg_ds = NULL;  in meson_pinctrl_parse_dt()
701 	struct meson_pinctrl *pc;  in meson_pinctrl_probe()  local
704 	pc = devm_kzalloc(dev, sizeof(struct meson_pinctrl), GFP_KERNEL);  in meson_pinctrl_probe()
705 	if (!pc)  in meson_pinctrl_probe()
708 	pc->dev = dev;  in meson_pinctrl_probe()
709 	pc->data = (struct meson_pinctrl_data *) of_device_get_match_data(dev);  in meson_pinctrl_probe()
711 	ret = meson_pinctrl_parse_dt(pc, dev->of_node);  in meson_pinctrl_probe()
715 	pc->desc.name		= "pinctrl-meson";  in meson_pinctrl_probe()
716 	pc->desc.owner		= THIS_MODULE;  in meson_pinctrl_probe()
717 	pc->desc.pctlops	= &meson_pctrl_ops;  in meson_pinctrl_probe()
718 	pc->desc.pmxops		= pc->data->pmx_ops;  in meson_pinctrl_probe()
719 	pc->desc.confops	= &meson_pinconf_ops;  in meson_pinctrl_probe()
720 	pc->desc.pins		= pc->data->pins;  in meson_pinctrl_probe()
721 	pc->desc.npins		= pc->data->num_pins;  in meson_pinctrl_probe()
723 	pc->pcdev = devm_pinctrl_register(pc->dev, &pc->desc, pc);  in meson_pinctrl_probe()
724 	if (IS_ERR(pc->pcdev)) {  in meson_pinctrl_probe()
725 		dev_err(pc->dev, "can't register pinctrl device");  in meson_pinctrl_probe()
726 		return PTR_ERR(pc->pcdev);  in meson_pinctrl_probe()
729 	return meson_gpiolib_register(pc);  in meson_pinctrl_probe()