29 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pctrl_get_groups_count()  local
31 	return pctl->ngroups;  in pxa2xx_pctrl_get_groups_count()
37 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pctrl_get_group_name()  local
38 	struct pxa_pinctrl_group *group = pctl->groups + tgroup;  in pxa2xx_pctrl_get_group_name()
48 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pctrl_get_group_pins()  local
49 	struct pxa_pinctrl_group *group = pctl->groups + tgroup;  in pxa2xx_pctrl_get_group_pins()
68 pxa_desc_by_func_group(struct pxa_pinctrl *pctl, const char *pin_name,  in pxa_desc_by_func_group()  argument
74 	for (i = 0; i < pctl->npins; i++) {  in pxa_desc_by_func_group()
75 		const struct pxa_desc_pin *pin = pctl->ppins + i;  in pxa_desc_by_func_group()
91 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pmx_gpio_set_direction()  local
96 	gpdr = pctl->base_gpdr[pin / 32];  in pxa2xx_pmx_gpio_set_direction()
97 	dev_dbg(pctl->dev, "set_direction(pin=%d): dir=%d\n",  in pxa2xx_pmx_gpio_set_direction()
100 	spin_lock_irqsave(&pctl->lock, flags);  in pxa2xx_pmx_gpio_set_direction()
106 	spin_unlock_irqrestore(&pctl->lock, flags);  in pxa2xx_pmx_gpio_set_direction()
114 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pmx_get_func_name()  local
115 	struct pxa_pinctrl_function *pf = pctl->functions + function;  in pxa2xx_pmx_get_func_name()
122 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_get_functions_count()  local
124 	return pctl->nfuncs;  in pxa2xx_get_functions_count()
132 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pmx_get_func_groups()  local
133 	struct pxa_pinctrl_function *pf = pctl->functions + function;  in pxa2xx_pmx_get_func_groups()
144 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pmx_set_mux()  local
145 	struct pxa_pinctrl_group *group = pctl->groups + tgroup;  in pxa2xx_pmx_set_mux()
153 	df = pxa_desc_by_func_group(pctl, group->name,  in pxa2xx_pmx_set_mux()
154 				    (pctl->functions + function)->name);  in pxa2xx_pmx_set_mux()
159 	gafr = pctl->base_gafr[pin / 16];  in pxa2xx_pmx_set_mux()
160 	gpdr = pctl->base_gpdr[pin / 32];  in pxa2xx_pmx_set_mux()
162 	dev_dbg(pctl->dev, "set_mux(pin=%d): af=%d dir=%d\n",  in pxa2xx_pmx_set_mux()
165 	spin_lock_irqsave(&pctl->lock, flags);  in pxa2xx_pmx_set_mux()
175 	spin_unlock_irqrestore(&pctl->lock, flags);  in pxa2xx_pmx_set_mux()
191 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pconf_group_get()  local
192 	struct pxa_pinctrl_group *g = pctl->groups + group;  in pxa2xx_pconf_group_get()
195 	void __iomem *pgsr = pctl->base_pgsr[pin / 32];  in pxa2xx_pconf_group_get()
198 	spin_lock_irqsave(&pctl->lock, flags);  in pxa2xx_pconf_group_get()
201 	spin_unlock_irqrestore(&pctl->lock, flags);  in pxa2xx_pconf_group_get()
203 	dev_dbg(pctl->dev, "get sleep gpio state(pin=%d) %d\n",  in pxa2xx_pconf_group_get()
213 	struct pxa_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev);  in pxa2xx_pconf_group_set()  local
214 	struct pxa_pinctrl_group *g = pctl->groups + group;  in pxa2xx_pconf_group_set()
217 	void __iomem *pgsr = pctl->base_pgsr[pin / 32];  in pxa2xx_pconf_group_set()
231 	dev_dbg(pctl->dev, "set sleep gpio state(pin=%d) %d\n",  in pxa2xx_pconf_group_set()
234 	spin_lock_irqsave(&pctl->lock, flags);  in pxa2xx_pconf_group_set()
238 	spin_unlock_irqrestore(&pctl->lock, flags);  in pxa2xx_pconf_group_set()
256 pxa2xx_find_function(struct pxa_pinctrl *pctl, const char *fname,  in pxa2xx_find_function()  argument
268 static int pxa2xx_build_functions(struct pxa_pinctrl *pctl)  in pxa2xx_build_functions()  argument
280 	functions = devm_kcalloc(pctl->dev, pctl->npins * 6,  in pxa2xx_build_functions()
285 	for (i = 0; i < pctl->npins; i++)  in pxa2xx_build_functions()
286 		for (df = pctl->ppins[i].functions; df->name; df++)  in pxa2xx_build_functions()
287 			if (!pxa2xx_find_function(pctl, df->name, functions))  in pxa2xx_build_functions()
288 				(functions + pctl->nfuncs++)->name = df->name;  in pxa2xx_build_functions()
289 	pctl->functions = devm_kmemdup(pctl->dev, functions,  in pxa2xx_build_functions()
290 				       pctl->nfuncs * sizeof(*functions),  in pxa2xx_build_functions()
292 	if (!pctl->functions)  in pxa2xx_build_functions()
295 	devm_kfree(pctl->dev, functions);  in pxa2xx_build_functions()
299 static int pxa2xx_build_groups(struct pxa_pinctrl *pctl)  in pxa2xx_build_groups()  argument
306 	gtmp = devm_kmalloc_array(pctl->dev, pctl->npins, sizeof(*gtmp),  in pxa2xx_build_groups()
311 	for (i = 0; i < pctl->nfuncs; i++) {  in pxa2xx_build_groups()
313 		for (j = 0; j < pctl->npins; j++)  in pxa2xx_build_groups()
314 			for (df = pctl->ppins[j].functions; df->name;  in pxa2xx_build_groups()
316 				if (!strcmp(pctl->functions[i].name,  in pxa2xx_build_groups()
319 						pctl->ppins[j].pin.name;  in pxa2xx_build_groups()
320 		func = pctl->functions + i;  in pxa2xx_build_groups()
323 			devm_kmalloc_array(pctl->dev, ngroups,  in pxa2xx_build_groups()
331 	devm_kfree(pctl->dev, gtmp);  in pxa2xx_build_groups()
335 static int pxa2xx_build_state(struct pxa_pinctrl *pctl,  in pxa2xx_build_state()  argument
342 	pctl->npins = npins;  in pxa2xx_build_state()
343 	pctl->ppins = ppins;  in pxa2xx_build_state()
344 	pctl->ngroups = npins;  in pxa2xx_build_state()
346 	pctl->desc.npins = npins;  in pxa2xx_build_state()
347 	pins = devm_kcalloc(pctl->dev, npins, sizeof(*pins), GFP_KERNEL);  in pxa2xx_build_state()
351 	pctl->desc.pins = pins;  in pxa2xx_build_state()
355 	pctl->groups = devm_kmalloc_array(pctl->dev, pctl->ngroups,  in pxa2xx_build_state()
356 					  sizeof(*pctl->groups), GFP_KERNEL);  in pxa2xx_build_state()
357 	if (!pctl->groups)  in pxa2xx_build_state()
361 		group = pctl->groups + i;  in pxa2xx_build_state()
366 	ret = pxa2xx_build_functions(pctl);  in pxa2xx_build_state()
370 	ret = pxa2xx_build_groups(pctl);  in pxa2xx_build_state()
382 	struct pxa_pinctrl *pctl;  in pxa2xx_pinctrl_init()  local
388 	pctl = devm_kzalloc(&pdev->dev, sizeof(*pctl), GFP_KERNEL);  in pxa2xx_pinctrl_init()
389 	if (!pctl)  in pxa2xx_pinctrl_init()
391 	pctl->base_gafr = devm_kcalloc(&pdev->dev, roundup(maxpin, 16),  in pxa2xx_pinctrl_init()
392 				       sizeof(*pctl->base_gafr), GFP_KERNEL);  in pxa2xx_pinctrl_init()
393 	pctl->base_gpdr = devm_kcalloc(&pdev->dev, roundup(maxpin, 32),  in pxa2xx_pinctrl_init()
394 				       sizeof(*pctl->base_gpdr), GFP_KERNEL);  in pxa2xx_pinctrl_init()
395 	pctl->base_pgsr = devm_kcalloc(&pdev->dev, roundup(maxpin, 32),  in pxa2xx_pinctrl_init()
396 				       sizeof(*pctl->base_pgsr), GFP_KERNEL);  in pxa2xx_pinctrl_init()
397 	if (!pctl->base_gafr || !pctl->base_gpdr || !pctl->base_pgsr)  in pxa2xx_pinctrl_init()
400 	platform_set_drvdata(pdev, pctl);  in pxa2xx_pinctrl_init()
401 	spin_lock_init(&pctl->lock);  in pxa2xx_pinctrl_init()
403 	pctl->dev = &pdev->dev;  in pxa2xx_pinctrl_init()
404 	pctl->desc = pxa2xx_pinctrl_desc;  in pxa2xx_pinctrl_init()
405 	pctl->desc.name = dev_name(&pdev->dev);  in pxa2xx_pinctrl_init()
406 	pctl->desc.owner = THIS_MODULE;  in pxa2xx_pinctrl_init()
409 		pctl->base_gafr[i / 16] = base_gafr[i / 16];  in pxa2xx_pinctrl_init()
411 		pctl->base_gpdr[i / 32] = base_gpdr[i / 32];  in pxa2xx_pinctrl_init()
412 		pctl->base_pgsr[i / 32] = base_pgsr[i / 32];  in pxa2xx_pinctrl_init()
415 	ret = pxa2xx_build_state(pctl, ppins, npins);  in pxa2xx_pinctrl_init()
419 	pctl->pctl_dev = devm_pinctrl_register(&pdev->dev, &pctl->desc, pctl);  in pxa2xx_pinctrl_init()
420 	if (IS_ERR(pctl->pctl_dev)) {  in pxa2xx_pinctrl_init()
422 		return PTR_ERR(pctl->pctl_dev);  in pxa2xx_pinctrl_init()
433 	struct pxa_pinctrl *pctl = platform_get_drvdata(pdev);  in pxa2xx_pinctrl_exit()  local
435 	pinctrl_unregister(pctl->pctl_dev);  in pxa2xx_pinctrl_exit()