32 static void muxregs_endisable(struct spear_pmx *pmx,  in muxregs_endisable()  argument
41 		val = pmx_readl(pmx, muxreg->reg);  in muxregs_endisable()
50 		pmx_writel(pmx, val, muxreg->reg);  in muxregs_endisable()
54 static int set_mode(struct spear_pmx *pmx, int mode)  in set_mode()  argument
60 	if (!pmx->machdata->pmx_modes || !pmx->machdata->npmx_modes)  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()
73 	val = pmx_readl(pmx, pmx_mode->reg);  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()
117 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_groups_cnt()  local
119 	return pmx->machdata->ngroups;  in spear_pinctrl_get_groups_cnt()
125 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_group_name()  local
127 	return pmx->machdata->groups[group]->name;  in spear_pinctrl_get_group_name()
133 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_group_pins()  local
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()
152 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_dt_node_to_map()  local
176 		dev_err(pmx->dev, "No child nodes passed via DT\n");  in spear_pinctrl_dt_node_to_map()
217 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_funcs_count()  local
219 	return pmx->machdata->nfunctions;  in spear_pinctrl_get_funcs_count()
225 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_func_name()  local
227 	return pmx->machdata->functions[function]->name;  in spear_pinctrl_get_func_name()
234 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_func_groups()  local
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()
245 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_endisable()  local
251 	pgroup = pmx->machdata->groups[group];  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()
283 static struct spear_gpio_pingroup *get_gpio_pingroup(struct spear_pmx *pmx,  in get_gpio_pingroup()  argument
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()
307 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in gpio_request_endisable()  local
308 	struct spear_pinctrl_machdata *machdata = pmx->machdata;  in gpio_request_endisable()
315 	gpio_pingroup = get_gpio_pingroup(pmx, offset);  in gpio_request_endisable()
317 		muxregs_endisable(pmx, gpio_pingroup->muxregs,  in gpio_request_endisable()
325 		machdata->gpio_request_endisable(pmx, offset, enable);  in gpio_request_endisable()
362 	struct spear_pmx *pmx;  in spear_pinctrl_probe()  local
367 	pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);  in spear_pinctrl_probe()
368 	if (!pmx)  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()
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()
390 		if (set_mode(pmx, mode)) {  in spear_pinctrl_probe()
397 	platform_set_drvdata(pdev, pmx);  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()
405 		return PTR_ERR(pmx->pctl);  in spear_pinctrl_probe()