2 * linux/drivers/pinctrl/pinctrl-pxa3xx.c
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * publishhed by the Free Software Foundation.
8 * Copyright (C) 2011, Marvell Technology Group Ltd.
10 * Author: Haojian Zhuang <haojian.zhuang@marvell.com>
14 #include <linux/err.h>
15 #include <linux/module.h>
16 #include <linux/device.h>
18 #include <linux/platform_device.h>
19 #include <linux/slab.h>
20 #include "pinctrl-pxa3xx.h"
22 static struct pinctrl_gpio_range pxa3xx_pinctrl_gpio_range = {
23 .name = "PXA3xx GPIO",
29 static int pxa3xx_get_groups_count(struct pinctrl_dev *pctrldev)
31 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
33 return info->num_grps;
36 static const char *pxa3xx_get_group_name(struct pinctrl_dev *pctrldev,
39 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
41 return info->grps[selector].name;
44 static int pxa3xx_get_group_pins(struct pinctrl_dev *pctrldev,
46 const unsigned **pins,
49 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
51 *pins = info->grps[selector].pins;
52 *num_pins = info->grps[selector].npins;
56 static struct pinctrl_ops pxa3xx_pctrl_ops = {
57 .get_groups_count = pxa3xx_get_groups_count,
58 .get_group_name = pxa3xx_get_group_name,
59 .get_group_pins = pxa3xx_get_group_pins,
62 static int pxa3xx_pmx_get_funcs_count(struct pinctrl_dev *pctrldev)
64 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
66 return info->num_funcs;
69 static const char *pxa3xx_pmx_get_func_name(struct pinctrl_dev *pctrldev,
72 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
73 return info->funcs[func].name;
76 static int pxa3xx_pmx_get_groups(struct pinctrl_dev *pctrldev, unsigned func,
77 const char * const **groups,
78 unsigned * const num_groups)
80 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
81 *groups = info->funcs[func].groups;
82 *num_groups = info->funcs[func].num_groups;
86 /* Return function number. If failure, return negative value. */
87 static int match_mux(struct pxa3xx_mfp_pin *mfp, unsigned mux)
90 for (i = 0; i < PXA3xx_MAX_MUX; i++) {
91 if (mfp->func[i] == mux)
94 if (i >= PXA3xx_MAX_MUX)
99 /* check whether current pin configuration is valid. Negative for failure */
100 static int match_group_mux(struct pxa3xx_pin_group *grp,
101 struct pxa3xx_pinmux_info *info,
105 for (i = 0; i < grp->npins; i++) {
107 ret = match_mux(&info->mfp[pin], mux);
109 dev_err(info->dev, "Can't find mux %d on pin%d\n",
117 static int pxa3xx_pmx_enable(struct pinctrl_dev *pctrldev, unsigned func,
120 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
121 struct pxa3xx_pin_group *pin_grp = &info->grps[group];
123 int i, mfpr, pin, pin_func;
125 if (!pin_grp->npins ||
126 (match_group_mux(pin_grp, info, pin_grp->mux) < 0)) {
127 dev_err(info->dev, "Failed to set the pin group: %d\n", group);
130 for (i = 0; i < pin_grp->npins; i++) {
131 pin = pin_grp->pins[i];
132 pin_func = match_mux(&info->mfp[pin], pin_grp->mux);
133 mfpr = info->mfp[pin].mfpr;
134 data = readl_relaxed(info->virt_base + mfpr);
135 data &= ~MFPR_FUNC_MASK;
137 writel_relaxed(data, info->virt_base + mfpr);
142 static int pxa3xx_pmx_request_gpio(struct pinctrl_dev *pctrldev,
143 struct pinctrl_gpio_range *range,
146 struct pxa3xx_pinmux_info *info = pinctrl_dev_get_drvdata(pctrldev);
150 pin_func = match_mux(&info->mfp[pin], PXA3xx_MUX_GPIO);
152 dev_err(info->dev, "No GPIO function on pin%d (%s)\n",
153 pin, info->pads[pin].name);
156 mfpr = info->mfp[pin].mfpr;
157 /* write gpio function into mfpr register */
158 data = readl_relaxed(info->virt_base + mfpr) & ~MFPR_FUNC_MASK;
160 writel_relaxed(data, info->virt_base + mfpr);
164 static struct pinmux_ops pxa3xx_pmx_ops = {
165 .get_functions_count = pxa3xx_pmx_get_funcs_count,
166 .get_function_name = pxa3xx_pmx_get_func_name,
167 .get_function_groups = pxa3xx_pmx_get_groups,
168 .enable = pxa3xx_pmx_enable,
169 .gpio_request_enable = pxa3xx_pmx_request_gpio,
172 int pxa3xx_pinctrl_register(struct platform_device *pdev,
173 struct pxa3xx_pinmux_info *info)
175 struct pinctrl_desc *desc;
176 struct resource *res;
178 if (!info || !info->cputype)
181 desc->pins = info->pads;
182 desc->npins = info->num_pads;
183 desc->pctlops = &pxa3xx_pctrl_ops;
184 desc->pmxops = &pxa3xx_pmx_ops;
185 info->dev = &pdev->dev;
186 pxa3xx_pinctrl_gpio_range.npins = info->num_gpio;
188 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
191 info->virt_base = devm_ioremap_resource(&pdev->dev, res);
192 if (IS_ERR(info->virt_base))
193 return PTR_ERR(info->virt_base);
194 info->pctrl = pinctrl_register(desc, &pdev->dev, info);
196 dev_err(&pdev->dev, "failed to register PXA pinmux driver\n");
199 pinctrl_add_gpio_range(info->pctrl, &pxa3xx_pinctrl_gpio_range);
200 platform_set_drvdata(pdev, info);
204 int pxa3xx_pinctrl_unregister(struct platform_device *pdev)
206 struct pxa3xx_pinmux_info *info = platform_get_drvdata(pdev);
208 pinctrl_unregister(info->pctrl);
209 platform_set_drvdata(pdev, NULL);
213 static int __init pxa3xx_pinctrl_init(void)
215 pr_info("pxa3xx-pinctrl: PXA3xx pinctrl driver initializing\n");
218 core_initcall_sync(pxa3xx_pinctrl_init);
220 static void __exit pxa3xx_pinctrl_exit(void)
223 module_exit(pxa3xx_pinctrl_exit);
225 MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
226 MODULE_DESCRIPTION("PXA3xx pin control driver");
227 MODULE_LICENSE("GPL v2");