8  * - U300 Pinctl drivers
9  * - Tegra Pinctl drivers
28 #include "pinctrl-spear.h"
30 #define DRIVER_NAME "spear-pinmux"
41 		val = pmx_readl(pmx, muxreg->reg);  in muxregs_endisable()
42 		val &= ~muxreg->mask;  in muxregs_endisable()
45 			temp = muxreg->val;  in muxregs_endisable()
47 			temp = ~muxreg->val;  in muxregs_endisable()
49 		val |= muxreg->mask & temp;  in muxregs_endisable()
50 		pmx_writel(pmx, val, muxreg->reg);  in muxregs_endisable()
60 	if (!pmx->machdata->pmx_modes || !pmx->machdata->npmx_modes)  in set_mode()
61 		return -EINVAL;  in set_mode()
63 	for (i = 0; i < pmx->machdata->npmx_modes; i++) {  in set_mode()
64 		if (pmx->machdata->pmx_modes[i]->mode == (1 << mode)) {  in set_mode()
65 			pmx_mode = pmx->machdata->pmx_modes[i];  in set_mode()
71 		return -EINVAL;  in set_mode()
73 	val = pmx_readl(pmx, pmx_mode->reg);  in set_mode()
74 	val &= ~pmx_mode->mask;  in set_mode()
75 	val |= pmx_mode->val;  in set_mode()
76 	pmx_writel(pmx, val, pmx_mode->reg);  in set_mode()
78 	pmx->machdata->mode = pmx_mode->mode;  in set_mode()
79 	dev_info(pmx->dev, "Configured Mode: %s with id: %x\n\n",  in set_mode()
80 			pmx_mode->name ? pmx_mode->name : "no_name",  in set_mode()
81 			pmx_mode->reg);  in set_mode()
102 	for (group = 0; group < machdata->ngroups; group++) {  in pmx_init_addr()
103 		pgroup = machdata->groups[group];  in pmx_init_addr()
105 		for (i = 0; i < pgroup->nmodemuxs; i++) {  in pmx_init_addr()
106 			modemux = &pgroup->modemuxs[i];  in pmx_init_addr()
108 			for (j = 0; j < modemux->nmuxregs; j++)  in pmx_init_addr()
109 				if (modemux->muxregs[j].reg == 0xFFFF)  in pmx_init_addr()
110 					modemux->muxregs[j].reg = reg;  in pmx_init_addr()
119 	return pmx->machdata->ngroups;  in spear_pinctrl_get_groups_cnt()
127 	return pmx->machdata->groups[group]->name;  in spear_pinctrl_get_group_name()
135 	*pins = pmx->machdata->groups[group]->pins;  in spear_pinctrl_get_group_pins()
136 	*num_pins = pmx->machdata->groups[group]->npins;  in spear_pinctrl_get_group_pins()
176 		dev_err(pmx->dev, "No child nodes passed via DT\n");  in spear_pinctrl_dt_node_to_map()
177 		return -ENODEV;  in spear_pinctrl_dt_node_to_map()
182 		return -ENOMEM;  in spear_pinctrl_dt_node_to_map()
219 	return pmx->machdata->nfunctions;  in spear_pinctrl_get_funcs_count()
227 	return pmx->machdata->functions[function]->name;  in spear_pinctrl_get_func_name()
236 	*groups = pmx->machdata->functions[function]->groups;  in spear_pinctrl_get_func_groups()
237 	*ngroups = pmx->machdata->functions[function]->ngroups;  in spear_pinctrl_get_func_groups()
251 	pgroup = pmx->machdata->groups[group];  in spear_pinctrl_endisable()
253 	for (i = 0; i < pgroup->nmodemuxs; i++) {  in spear_pinctrl_endisable()
254 		modemux = &pgroup->modemuxs[i];  in spear_pinctrl_endisable()
257 		if (pmx->machdata->modes_supported) {  in spear_pinctrl_endisable()
258 			if (!(pmx->machdata->mode & modemux->modes))  in spear_pinctrl_endisable()
263 		muxregs_endisable(pmx, modemux->muxregs, modemux->nmuxregs,  in spear_pinctrl_endisable()
268 		dev_err(pmx->dev, "pinmux group: %s not supported\n",  in spear_pinctrl_endisable()
269 				pgroup->name);  in spear_pinctrl_endisable()
270 		return -ENODEV;  in spear_pinctrl_endisable()
289 	if (!pmx->machdata->gpio_pingroups)  in get_gpio_pingroup()
292 	for (i = 0; i < pmx->machdata->ngpio_pingroups; i++) {  in get_gpio_pingroup()
293 		gpio_pingroup = &pmx->machdata->gpio_pingroups[i];  in get_gpio_pingroup()
295 		for (j = 0; j < gpio_pingroup->npins; j++) {  in get_gpio_pingroup()
296 			if (gpio_pingroup->pins[j] == pin)  in get_gpio_pingroup()
308 	struct spear_pinctrl_machdata *machdata = pmx->machdata;  in gpio_request_endisable()
317 		muxregs_endisable(pmx, gpio_pingroup->muxregs,  in gpio_request_endisable()
318 				gpio_pingroup->nmuxregs, enable);  in gpio_request_endisable()
324 	if (machdata->gpio_request_endisable)  in gpio_request_endisable()
325 		machdata->gpio_request_endisable(pmx, offset, enable);  in gpio_request_endisable()
361 	struct device_node *np = pdev->dev.of_node;  in spear_pinctrl_probe()
365 		return -ENODEV;  in spear_pinctrl_probe()
367 	pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);  in spear_pinctrl_probe()
369 		return -ENOMEM;  in spear_pinctrl_probe()
371 	pmx->regmap = device_node_to_regmap(np);  in spear_pinctrl_probe()
372 	if (IS_ERR(pmx->regmap)) {  in spear_pinctrl_probe()
373 		dev_err(&pdev->dev, "Init regmap failed (%pe).\n",  in spear_pinctrl_probe()
374 			pmx->regmap);  in spear_pinctrl_probe()
375 		return PTR_ERR(pmx->regmap);  in spear_pinctrl_probe()
378 	pmx->dev = &pdev->dev;  in spear_pinctrl_probe()
379 	pmx->machdata = machdata;  in spear_pinctrl_probe()
382 	if (machdata->modes_supported) {  in spear_pinctrl_probe()
385 		if (of_property_read_u32(np, "st,pinmux-mode", &mode)) {  in spear_pinctrl_probe()
386 			dev_err(&pdev->dev, "OF: pinmux mode not passed\n");  in spear_pinctrl_probe()
387 			return -EINVAL;  in spear_pinctrl_probe()
391 			dev_err(&pdev->dev, "OF: Couldn't configure mode: %x\n",  in spear_pinctrl_probe()
393 			return -EINVAL;  in spear_pinctrl_probe()
399 	spear_pinctrl_desc.pins = machdata->pins;  in spear_pinctrl_probe()
400 	spear_pinctrl_desc.npins = machdata->npins;  in spear_pinctrl_probe()
402 	pmx->pctl = devm_pinctrl_register(&pdev->dev, &spear_pinctrl_desc, pmx);  in spear_pinctrl_probe()
403 	if (IS_ERR(pmx->pctl)) {  in spear_pinctrl_probe()
404 		dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");  in spear_pinctrl_probe()
405 		return PTR_ERR(pmx->pctl);  in spear_pinctrl_probe()