33 static void muxregs_endisable(struct spear_pmx *pmx,  in muxregs_endisable()  argument
42 		val = pmx_readl(pmx, muxreg->reg);  in muxregs_endisable()
51 		pmx_writel(pmx, val, muxreg->reg);  in muxregs_endisable()
55 static int set_mode(struct spear_pmx *pmx, int mode)  in set_mode()  argument
61 	if (!pmx->machdata->pmx_modes || !pmx->machdata->npmx_modes)  in set_mode()
64 	for (i = 0; i < pmx->machdata->npmx_modes; i++) {  in set_mode()
65 		if (pmx->machdata->pmx_modes[i]->mode == (1 << mode)) {  in set_mode()
66 			pmx_mode = pmx->machdata->pmx_modes[i];  in set_mode()
74 	val = pmx_readl(pmx, pmx_mode->reg);  in set_mode()
77 	pmx_writel(pmx, val, pmx_mode->reg);  in set_mode()
79 	pmx->machdata->mode = pmx_mode->mode;  in set_mode()
80 	dev_info(pmx->dev, "Configured Mode: %s with id: %x\n\n",  in set_mode()
118 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_groups_cnt()  local
120 	return pmx->machdata->ngroups;  in spear_pinctrl_get_groups_cnt()
126 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_group_name()  local
128 	return pmx->machdata->groups[group]->name;  in spear_pinctrl_get_group_name()
134 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_group_pins()  local
136 	*pins = pmx->machdata->groups[group]->pins;  in spear_pinctrl_get_group_pins()
137 	*num_pins = pmx->machdata->groups[group]->npins;  in spear_pinctrl_get_group_pins()
153 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_dt_node_to_map()  local
177 		dev_err(pmx->dev, "No child nodes passed via DT\n");  in spear_pinctrl_dt_node_to_map()
218 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_funcs_count()  local
220 	return pmx->machdata->nfunctions;  in spear_pinctrl_get_funcs_count()
226 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_func_name()  local
228 	return pmx->machdata->functions[function]->name;  in spear_pinctrl_get_func_name()
235 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_get_func_groups()  local
237 	*groups = pmx->machdata->functions[function]->groups;  in spear_pinctrl_get_func_groups()
238 	*ngroups = pmx->machdata->functions[function]->ngroups;  in spear_pinctrl_get_func_groups()
246 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in spear_pinctrl_endisable()  local
252 	pgroup = pmx->machdata->groups[group];  in spear_pinctrl_endisable()
258 		if (pmx->machdata->modes_supported) {  in spear_pinctrl_endisable()
259 			if (!(pmx->machdata->mode & modemux->modes))  in spear_pinctrl_endisable()
264 		muxregs_endisable(pmx, modemux->muxregs, modemux->nmuxregs,  in spear_pinctrl_endisable()
269 		dev_err(pmx->dev, "pinmux group: %s not supported\n",  in spear_pinctrl_endisable()
284 static struct spear_gpio_pingroup *get_gpio_pingroup(struct spear_pmx *pmx,  in get_gpio_pingroup()  argument
290 	if (!pmx->machdata->gpio_pingroups)  in get_gpio_pingroup()
293 	for (i = 0; i < pmx->machdata->ngpio_pingroups; i++) {  in get_gpio_pingroup()
294 		gpio_pingroup = &pmx->machdata->gpio_pingroups[i];  in get_gpio_pingroup()
308 	struct spear_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);  in gpio_request_endisable()  local
309 	struct spear_pinctrl_machdata *machdata = pmx->machdata;  in gpio_request_endisable()
316 	gpio_pingroup = get_gpio_pingroup(pmx, offset);  in gpio_request_endisable()
318 		muxregs_endisable(pmx, gpio_pingroup->muxregs,  in gpio_request_endisable()
326 		machdata->gpio_request_endisable(pmx, offset, enable);  in gpio_request_endisable()
363 	struct spear_pmx *pmx;  in spear_pinctrl_probe()  local
368 	pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);  in spear_pinctrl_probe()
369 	if (!pmx)  in spear_pinctrl_probe()
372 	pmx->regmap = device_node_to_regmap(np);  in spear_pinctrl_probe()
373 	if (IS_ERR(pmx->regmap)) {  in spear_pinctrl_probe()
375 			pmx->regmap);  in spear_pinctrl_probe()
376 		return PTR_ERR(pmx->regmap);  in spear_pinctrl_probe()
379 	pmx->dev = &pdev->dev;  in spear_pinctrl_probe()
380 	pmx->machdata = machdata;  in spear_pinctrl_probe()
391 		if (set_mode(pmx, mode)) {  in spear_pinctrl_probe()
398 	platform_set_drvdata(pdev, pmx);  in spear_pinctrl_probe()
403 	pmx->pctl = devm_pinctrl_register(&pdev->dev, &spear_pinctrl_desc, pmx);  in spear_pinctrl_probe()
404 	if (IS_ERR(pmx->pctl)) {  in spear_pinctrl_probe()
406 		return PTR_ERR(pmx->pctl);  in spear_pinctrl_probe()