183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2677b5358SBeniamino Galvani /*
3677b5358SBeniamino Galvani * (C) Copyright 2016 - Beniamino Galvani <b.galvani@gmail.com>
4677b5358SBeniamino Galvani */
5677b5358SBeniamino Galvani
6677b5358SBeniamino Galvani #include <common.h>
79d922450SSimon Glass #include <dm.h>
82009a8d0SBeniamino Galvani #include <dm/device-internal.h>
92009a8d0SBeniamino Galvani #include <dm/lists.h>
10677b5358SBeniamino Galvani #include <dm/pinctrl.h>
11677b5358SBeniamino Galvani #include <fdt_support.h>
12677b5358SBeniamino Galvani #include <linux/err.h>
13677b5358SBeniamino Galvani #include <linux/io.h>
14677b5358SBeniamino Galvani #include <linux/sizes.h>
152009a8d0SBeniamino Galvani #include <asm/gpio.h>
16677b5358SBeniamino Galvani
17677b5358SBeniamino Galvani #include "pinctrl-meson.h"
18677b5358SBeniamino Galvani
19677b5358SBeniamino Galvani DECLARE_GLOBAL_DATA_PTR;
20677b5358SBeniamino Galvani
21677b5358SBeniamino Galvani static const char *meson_pinctrl_dummy_name = "_dummy";
22677b5358SBeniamino Galvani
meson_pinctrl_get_groups_count(struct udevice * dev)237c9dcfedSJerome Brunet int meson_pinctrl_get_groups_count(struct udevice *dev)
24677b5358SBeniamino Galvani {
25677b5358SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev);
26677b5358SBeniamino Galvani
27677b5358SBeniamino Galvani return priv->data->num_groups;
28677b5358SBeniamino Galvani }
29677b5358SBeniamino Galvani
meson_pinctrl_get_group_name(struct udevice * dev,unsigned int selector)307c9dcfedSJerome Brunet const char *meson_pinctrl_get_group_name(struct udevice *dev,
317c9dcfedSJerome Brunet unsigned int selector)
32677b5358SBeniamino Galvani {
33677b5358SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev);
34677b5358SBeniamino Galvani
35677b5358SBeniamino Galvani if (!priv->data->groups[selector].name)
36677b5358SBeniamino Galvani return meson_pinctrl_dummy_name;
37677b5358SBeniamino Galvani
38677b5358SBeniamino Galvani return priv->data->groups[selector].name;
39677b5358SBeniamino Galvani }
40677b5358SBeniamino Galvani
meson_pinmux_get_functions_count(struct udevice * dev)417c9dcfedSJerome Brunet int meson_pinmux_get_functions_count(struct udevice *dev)
42677b5358SBeniamino Galvani {
43677b5358SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev);
44677b5358SBeniamino Galvani
45677b5358SBeniamino Galvani return priv->data->num_funcs;
46677b5358SBeniamino Galvani }
47677b5358SBeniamino Galvani
meson_pinmux_get_function_name(struct udevice * dev,unsigned int selector)487c9dcfedSJerome Brunet const char *meson_pinmux_get_function_name(struct udevice *dev,
497c9dcfedSJerome Brunet unsigned int selector)
50677b5358SBeniamino Galvani {
51677b5358SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev);
52677b5358SBeniamino Galvani
53677b5358SBeniamino Galvani return priv->data->funcs[selector].name;
54677b5358SBeniamino Galvani }
55677b5358SBeniamino Galvani
meson_gpio_calc_reg_and_bit(struct udevice * dev,unsigned int offset,enum meson_reg_type reg_type,unsigned int * reg,unsigned int * bit)562009a8d0SBeniamino Galvani static int meson_gpio_calc_reg_and_bit(struct udevice *dev, unsigned int offset,
572009a8d0SBeniamino Galvani enum meson_reg_type reg_type,
582009a8d0SBeniamino Galvani unsigned int *reg, unsigned int *bit)
592009a8d0SBeniamino Galvani {
60*c4c726c2SJerome Brunet struct meson_pinctrl *priv = dev_get_priv(dev);
612009a8d0SBeniamino Galvani struct meson_bank *bank = NULL;
622009a8d0SBeniamino Galvani struct meson_reg_desc *desc;
632009a8d0SBeniamino Galvani unsigned int pin;
642009a8d0SBeniamino Galvani int i;
652009a8d0SBeniamino Galvani
662009a8d0SBeniamino Galvani pin = priv->data->pin_base + offset;
672009a8d0SBeniamino Galvani
682009a8d0SBeniamino Galvani for (i = 0; i < priv->data->num_banks; i++) {
692009a8d0SBeniamino Galvani if (pin >= priv->data->banks[i].first &&
702009a8d0SBeniamino Galvani pin <= priv->data->banks[i].last) {
712009a8d0SBeniamino Galvani bank = &priv->data->banks[i];
722009a8d0SBeniamino Galvani break;
732009a8d0SBeniamino Galvani }
742009a8d0SBeniamino Galvani }
752009a8d0SBeniamino Galvani
762009a8d0SBeniamino Galvani if (!bank)
772009a8d0SBeniamino Galvani return -EINVAL;
782009a8d0SBeniamino Galvani
792009a8d0SBeniamino Galvani desc = &bank->regs[reg_type];
802009a8d0SBeniamino Galvani *reg = desc->reg * 4;
812009a8d0SBeniamino Galvani *bit = desc->bit + pin - bank->first;
822009a8d0SBeniamino Galvani
832009a8d0SBeniamino Galvani return 0;
842009a8d0SBeniamino Galvani }
852009a8d0SBeniamino Galvani
meson_gpio_get(struct udevice * dev,unsigned int offset)867c9dcfedSJerome Brunet int meson_gpio_get(struct udevice *dev, unsigned int offset)
872009a8d0SBeniamino Galvani {
882009a8d0SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev->parent);
892009a8d0SBeniamino Galvani unsigned int reg, bit;
902009a8d0SBeniamino Galvani int ret;
912009a8d0SBeniamino Galvani
92*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_IN, ®,
93*c4c726c2SJerome Brunet &bit);
942009a8d0SBeniamino Galvani if (ret)
952009a8d0SBeniamino Galvani return ret;
962009a8d0SBeniamino Galvani
972009a8d0SBeniamino Galvani return !!(readl(priv->reg_gpio + reg) & BIT(bit));
982009a8d0SBeniamino Galvani }
992009a8d0SBeniamino Galvani
meson_gpio_set(struct udevice * dev,unsigned int offset,int value)1007c9dcfedSJerome Brunet int meson_gpio_set(struct udevice *dev, unsigned int offset, int value)
1012009a8d0SBeniamino Galvani {
1022009a8d0SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev->parent);
1032009a8d0SBeniamino Galvani unsigned int reg, bit;
1042009a8d0SBeniamino Galvani int ret;
1052009a8d0SBeniamino Galvani
106*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_OUT, ®,
107*c4c726c2SJerome Brunet &bit);
1082009a8d0SBeniamino Galvani if (ret)
1092009a8d0SBeniamino Galvani return ret;
1102009a8d0SBeniamino Galvani
1112009a8d0SBeniamino Galvani clrsetbits_le32(priv->reg_gpio + reg, BIT(bit), value ? BIT(bit) : 0);
1122009a8d0SBeniamino Galvani
1132009a8d0SBeniamino Galvani return 0;
1142009a8d0SBeniamino Galvani }
1152009a8d0SBeniamino Galvani
meson_gpio_get_direction(struct udevice * dev,unsigned int offset)1167c9dcfedSJerome Brunet int meson_gpio_get_direction(struct udevice *dev, unsigned int offset)
1172009a8d0SBeniamino Galvani {
1182009a8d0SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev->parent);
1192009a8d0SBeniamino Galvani unsigned int reg, bit, val;
1202009a8d0SBeniamino Galvani int ret;
1212009a8d0SBeniamino Galvani
122*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_DIR, ®,
123*c4c726c2SJerome Brunet &bit);
1242009a8d0SBeniamino Galvani if (ret)
1252009a8d0SBeniamino Galvani return ret;
1262009a8d0SBeniamino Galvani
1272009a8d0SBeniamino Galvani val = readl(priv->reg_gpio + reg);
1282009a8d0SBeniamino Galvani
1292009a8d0SBeniamino Galvani return (val & BIT(bit)) ? GPIOF_INPUT : GPIOF_OUTPUT;
1302009a8d0SBeniamino Galvani }
1312009a8d0SBeniamino Galvani
meson_gpio_direction_input(struct udevice * dev,unsigned int offset)1327c9dcfedSJerome Brunet int meson_gpio_direction_input(struct udevice *dev, unsigned int offset)
1332009a8d0SBeniamino Galvani {
1342009a8d0SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev->parent);
1352009a8d0SBeniamino Galvani unsigned int reg, bit;
1362009a8d0SBeniamino Galvani int ret;
1372009a8d0SBeniamino Galvani
138*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_DIR, ®,
139*c4c726c2SJerome Brunet &bit);
1402009a8d0SBeniamino Galvani if (ret)
1412009a8d0SBeniamino Galvani return ret;
1422009a8d0SBeniamino Galvani
143fb19c7baSCarlo Caione setbits_le32(priv->reg_gpio + reg, BIT(bit));
1442009a8d0SBeniamino Galvani
1452009a8d0SBeniamino Galvani return 0;
1462009a8d0SBeniamino Galvani }
1472009a8d0SBeniamino Galvani
meson_gpio_direction_output(struct udevice * dev,unsigned int offset,int value)1487c9dcfedSJerome Brunet int meson_gpio_direction_output(struct udevice *dev,
1492009a8d0SBeniamino Galvani unsigned int offset, int value)
1502009a8d0SBeniamino Galvani {
1512009a8d0SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev->parent);
1522009a8d0SBeniamino Galvani unsigned int reg, bit;
1532009a8d0SBeniamino Galvani int ret;
1542009a8d0SBeniamino Galvani
155*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_DIR, ®,
156*c4c726c2SJerome Brunet &bit);
1572009a8d0SBeniamino Galvani if (ret)
1582009a8d0SBeniamino Galvani return ret;
1592009a8d0SBeniamino Galvani
160fb19c7baSCarlo Caione clrbits_le32(priv->reg_gpio + reg, BIT(bit));
1612009a8d0SBeniamino Galvani
162*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_OUT, ®,
163*c4c726c2SJerome Brunet &bit);
1642009a8d0SBeniamino Galvani if (ret)
1652009a8d0SBeniamino Galvani return ret;
1662009a8d0SBeniamino Galvani
1672009a8d0SBeniamino Galvani clrsetbits_le32(priv->reg_gpio + reg, BIT(bit), value ? BIT(bit) : 0);
1682009a8d0SBeniamino Galvani
1692009a8d0SBeniamino Galvani return 0;
1702009a8d0SBeniamino Galvani }
1712009a8d0SBeniamino Galvani
meson_pinconf_bias_set(struct udevice * dev,unsigned int pin,unsigned int param)172*c4c726c2SJerome Brunet static int meson_pinconf_bias_set(struct udevice *dev, unsigned int pin,
173*c4c726c2SJerome Brunet unsigned int param)
174*c4c726c2SJerome Brunet {
175*c4c726c2SJerome Brunet struct meson_pinctrl *priv = dev_get_priv(dev);
176*c4c726c2SJerome Brunet unsigned int offset = pin - priv->data->pin_base;
177*c4c726c2SJerome Brunet unsigned int reg, bit;
178*c4c726c2SJerome Brunet int ret;
179*c4c726c2SJerome Brunet
180*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev, offset, REG_PULLEN, ®, &bit);
181*c4c726c2SJerome Brunet if (ret)
182*c4c726c2SJerome Brunet return ret;
183*c4c726c2SJerome Brunet
184*c4c726c2SJerome Brunet if (param == PIN_CONFIG_BIAS_DISABLE) {
185*c4c726c2SJerome Brunet clrsetbits_le32(priv->reg_pullen + reg, BIT(bit), 0);
186*c4c726c2SJerome Brunet return 0;
187*c4c726c2SJerome Brunet }
188*c4c726c2SJerome Brunet
189*c4c726c2SJerome Brunet /* othewise, enable the bias and select level */
190*c4c726c2SJerome Brunet clrsetbits_le32(priv->reg_pullen + reg, BIT(bit), 1);
191*c4c726c2SJerome Brunet ret = meson_gpio_calc_reg_and_bit(dev, offset, REG_PULL, ®, &bit);
192*c4c726c2SJerome Brunet if (ret)
193*c4c726c2SJerome Brunet return ret;
194*c4c726c2SJerome Brunet
195*c4c726c2SJerome Brunet clrsetbits_le32(priv->reg_pull + reg, BIT(bit),
196*c4c726c2SJerome Brunet param == PIN_CONFIG_BIAS_PULL_UP);
197*c4c726c2SJerome Brunet
198*c4c726c2SJerome Brunet return 0;
199*c4c726c2SJerome Brunet }
200*c4c726c2SJerome Brunet
meson_pinconf_set(struct udevice * dev,unsigned int pin,unsigned int param,unsigned int arg)201*c4c726c2SJerome Brunet int meson_pinconf_set(struct udevice *dev, unsigned int pin,
202*c4c726c2SJerome Brunet unsigned int param, unsigned int arg)
203*c4c726c2SJerome Brunet {
204*c4c726c2SJerome Brunet int ret;
205*c4c726c2SJerome Brunet
206*c4c726c2SJerome Brunet switch (param) {
207*c4c726c2SJerome Brunet case PIN_CONFIG_BIAS_DISABLE:
208*c4c726c2SJerome Brunet case PIN_CONFIG_BIAS_PULL_UP:
209*c4c726c2SJerome Brunet case PIN_CONFIG_BIAS_PULL_DOWN:
210*c4c726c2SJerome Brunet ret = meson_pinconf_bias_set(dev, pin, param);
211*c4c726c2SJerome Brunet break;
212*c4c726c2SJerome Brunet
213*c4c726c2SJerome Brunet default:
214*c4c726c2SJerome Brunet dev_err(dev, "unsupported configuration parameter %u\n", param);
215*c4c726c2SJerome Brunet return -EINVAL;
216*c4c726c2SJerome Brunet }
217*c4c726c2SJerome Brunet
218*c4c726c2SJerome Brunet return ret;
219*c4c726c2SJerome Brunet }
220*c4c726c2SJerome Brunet
meson_pinconf_group_set(struct udevice * dev,unsigned int group_selector,unsigned int param,unsigned int arg)221*c4c726c2SJerome Brunet int meson_pinconf_group_set(struct udevice *dev,
222*c4c726c2SJerome Brunet unsigned int group_selector,
223*c4c726c2SJerome Brunet unsigned int param, unsigned int arg)
224*c4c726c2SJerome Brunet {
225*c4c726c2SJerome Brunet struct meson_pinctrl *priv = dev_get_priv(dev);
226*c4c726c2SJerome Brunet struct meson_pmx_group *grp = &priv->data->groups[group_selector];
227*c4c726c2SJerome Brunet int i, ret;
228*c4c726c2SJerome Brunet
229*c4c726c2SJerome Brunet for (i = 0; i < grp->num_pins; i++) {
230*c4c726c2SJerome Brunet ret = meson_pinconf_set(dev, grp->pins[i], param, arg);
231*c4c726c2SJerome Brunet if (ret)
232*c4c726c2SJerome Brunet return ret;
233*c4c726c2SJerome Brunet }
234*c4c726c2SJerome Brunet
235*c4c726c2SJerome Brunet return 0;
236*c4c726c2SJerome Brunet }
237*c4c726c2SJerome Brunet
meson_gpio_probe(struct udevice * dev)2387c9dcfedSJerome Brunet int meson_gpio_probe(struct udevice *dev)
2392009a8d0SBeniamino Galvani {
2402009a8d0SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev->parent);
2412009a8d0SBeniamino Galvani struct gpio_dev_priv *uc_priv;
2422009a8d0SBeniamino Galvani
2432009a8d0SBeniamino Galvani uc_priv = dev_get_uclass_priv(dev);
2442009a8d0SBeniamino Galvani uc_priv->bank_name = priv->data->name;
2452009a8d0SBeniamino Galvani uc_priv->gpio_count = priv->data->num_pins;
2462009a8d0SBeniamino Galvani
2472009a8d0SBeniamino Galvani return 0;
2482009a8d0SBeniamino Galvani }
2492009a8d0SBeniamino Galvani
parse_address(int offset,const char * name,int na,int ns)250677b5358SBeniamino Galvani static fdt_addr_t parse_address(int offset, const char *name, int na, int ns)
251677b5358SBeniamino Galvani {
252677b5358SBeniamino Galvani int index, len = 0;
253677b5358SBeniamino Galvani const fdt32_t *reg;
254677b5358SBeniamino Galvani
255b02e4044SSimon Glass index = fdt_stringlist_search(gd->fdt_blob, offset, "reg-names", name);
256677b5358SBeniamino Galvani if (index < 0)
257677b5358SBeniamino Galvani return FDT_ADDR_T_NONE;
258677b5358SBeniamino Galvani
259677b5358SBeniamino Galvani reg = fdt_getprop(gd->fdt_blob, offset, "reg", &len);
260677b5358SBeniamino Galvani if (!reg || (len <= (index * sizeof(fdt32_t) * (na + ns))))
261677b5358SBeniamino Galvani return FDT_ADDR_T_NONE;
262677b5358SBeniamino Galvani
263677b5358SBeniamino Galvani reg += index * (na + ns);
264677b5358SBeniamino Galvani
265677b5358SBeniamino Galvani return fdt_translate_address((void *)gd->fdt_blob, offset, reg);
266677b5358SBeniamino Galvani }
267677b5358SBeniamino Galvani
meson_pinctrl_probe(struct udevice * dev)268677b5358SBeniamino Galvani int meson_pinctrl_probe(struct udevice *dev)
269677b5358SBeniamino Galvani {
270677b5358SBeniamino Galvani struct meson_pinctrl *priv = dev_get_priv(dev);
2712009a8d0SBeniamino Galvani struct uclass_driver *drv;
2722009a8d0SBeniamino Galvani struct udevice *gpio_dev;
273677b5358SBeniamino Galvani fdt_addr_t addr;
274677b5358SBeniamino Galvani int node, gpio = -1, len;
275677b5358SBeniamino Galvani int na, ns;
2762009a8d0SBeniamino Galvani char *name;
277677b5358SBeniamino Galvani
278e160f7d4SSimon Glass na = fdt_address_cells(gd->fdt_blob, dev_of_offset(dev->parent));
279677b5358SBeniamino Galvani if (na < 1) {
280677b5358SBeniamino Galvani debug("bad #address-cells\n");
281677b5358SBeniamino Galvani return -EINVAL;
282677b5358SBeniamino Galvani }
283677b5358SBeniamino Galvani
284e160f7d4SSimon Glass ns = fdt_size_cells(gd->fdt_blob, dev_of_offset(dev->parent));
285677b5358SBeniamino Galvani if (ns < 1) {
286677b5358SBeniamino Galvani debug("bad #size-cells\n");
287677b5358SBeniamino Galvani return -EINVAL;
288677b5358SBeniamino Galvani }
289677b5358SBeniamino Galvani
290e160f7d4SSimon Glass fdt_for_each_subnode(node, gd->fdt_blob, dev_of_offset(dev)) {
291677b5358SBeniamino Galvani if (fdt_getprop(gd->fdt_blob, node, "gpio-controller", &len)) {
292677b5358SBeniamino Galvani gpio = node;
293677b5358SBeniamino Galvani break;
294677b5358SBeniamino Galvani }
295677b5358SBeniamino Galvani }
296677b5358SBeniamino Galvani
297677b5358SBeniamino Galvani if (!gpio) {
298677b5358SBeniamino Galvani debug("gpio node not found\n");
299677b5358SBeniamino Galvani return -EINVAL;
300677b5358SBeniamino Galvani }
301677b5358SBeniamino Galvani
302677b5358SBeniamino Galvani addr = parse_address(gpio, "mux", na, ns);
303677b5358SBeniamino Galvani if (addr == FDT_ADDR_T_NONE) {
3042009a8d0SBeniamino Galvani debug("mux address not found\n");
305677b5358SBeniamino Galvani return -EINVAL;
306677b5358SBeniamino Galvani }
307677b5358SBeniamino Galvani priv->reg_mux = (void __iomem *)addr;
3082009a8d0SBeniamino Galvani
3092009a8d0SBeniamino Galvani addr = parse_address(gpio, "gpio", na, ns);
3102009a8d0SBeniamino Galvani if (addr == FDT_ADDR_T_NONE) {
3112009a8d0SBeniamino Galvani debug("gpio address not found\n");
3122009a8d0SBeniamino Galvani return -EINVAL;
3132009a8d0SBeniamino Galvani }
3142009a8d0SBeniamino Galvani priv->reg_gpio = (void __iomem *)addr;
315*c4c726c2SJerome Brunet
316*c4c726c2SJerome Brunet addr = parse_address(gpio, "pull", na, ns);
317*c4c726c2SJerome Brunet if (addr == FDT_ADDR_T_NONE) {
318*c4c726c2SJerome Brunet debug("pull address not found\n");
319*c4c726c2SJerome Brunet return -EINVAL;
320*c4c726c2SJerome Brunet }
321*c4c726c2SJerome Brunet priv->reg_pull = (void __iomem *)addr;
322*c4c726c2SJerome Brunet
323*c4c726c2SJerome Brunet addr = parse_address(gpio, "pull-enable", na, ns);
324*c4c726c2SJerome Brunet /* Use pull region if pull-enable one is not present */
325*c4c726c2SJerome Brunet if (addr == FDT_ADDR_T_NONE)
326*c4c726c2SJerome Brunet priv->reg_pullen = priv->reg_pull;
327*c4c726c2SJerome Brunet else
328*c4c726c2SJerome Brunet priv->reg_pullen = (void __iomem *)addr;
329*c4c726c2SJerome Brunet
330677b5358SBeniamino Galvani priv->data = (struct meson_pinctrl_data *)dev_get_driver_data(dev);
331677b5358SBeniamino Galvani
3322009a8d0SBeniamino Galvani /* Lookup GPIO driver */
3332009a8d0SBeniamino Galvani drv = lists_uclass_lookup(UCLASS_GPIO);
3342009a8d0SBeniamino Galvani if (!drv) {
3352009a8d0SBeniamino Galvani puts("Cannot find GPIO driver\n");
3362009a8d0SBeniamino Galvani return -ENOENT;
3372009a8d0SBeniamino Galvani }
3382009a8d0SBeniamino Galvani
3392009a8d0SBeniamino Galvani name = calloc(1, 32);
3402009a8d0SBeniamino Galvani sprintf(name, "meson-gpio");
3412009a8d0SBeniamino Galvani
3422009a8d0SBeniamino Galvani /* Create child device UCLASS_GPIO and bind it */
3437c9dcfedSJerome Brunet device_bind(dev, priv->data->gpio_driver, name, NULL, gpio, &gpio_dev);
3442009a8d0SBeniamino Galvani dev_set_of_offset(gpio_dev, gpio);
3452009a8d0SBeniamino Galvani
346677b5358SBeniamino Galvani return 0;
347677b5358SBeniamino Galvani }
348