2 * Copyright (C) 2015-2016 Socionext Inc.
3 * Author: Masahiro Yamada <yamada.masahiro@socionext.com>
5 * SPDX-License-Identifier: GPL-2.0+
10 #include <linux/sizes.h>
11 #include <dm/device.h>
12 #include <dm/pinctrl.h>
14 #include "pinctrl-uniphier.h"
16 #define UNIPHIER_PINCTRL_PINMUX_BASE 0x1000
17 #define UNIPHIER_PINCTRL_LOAD_PINMUX 0x1700
18 #define UNIPHIER_PINCTRL_IECTRL 0x1d00
20 static const char *uniphier_pinctrl_dummy_name = "_dummy";
22 static int uniphier_pinctrl_get_groups_count(struct udevice *dev)
24 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
26 return priv->socdata->groups_count;
29 static const char *uniphier_pinctrl_get_group_name(struct udevice *dev,
32 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
34 if (!priv->socdata->groups[selector].name)
35 return uniphier_pinctrl_dummy_name;
37 return priv->socdata->groups[selector].name;
40 static int uniphier_pinmux_get_functions_count(struct udevice *dev)
42 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
44 return priv->socdata->functions_count;
47 static const char *uniphier_pinmux_get_function_name(struct udevice *dev,
50 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
52 if (!priv->socdata->functions[selector])
53 return uniphier_pinctrl_dummy_name;
55 return priv->socdata->functions[selector];
58 static void uniphier_pinconf_input_enable_perpin(struct udevice *dev,
61 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
65 reg = UNIPHIER_PINCTRL_IECTRL + pin / 32 * 4;
68 tmp = readl(priv->base + reg);
70 writel(tmp, priv->base + reg);
73 static void uniphier_pinconf_input_enable_legacy(struct udevice *dev,
76 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
77 int pins_count = priv->socdata->pins_count;
78 const struct uniphier_pinctrl_pin *pins = priv->socdata->pins;
81 for (i = 0; i < pins_count; i++) {
82 if (pins[i].number == pin) {
86 iectrl = uniphier_pin_get_iectrl(pins[i].data);
87 tmp = readl(priv->base + UNIPHIER_PINCTRL_IECTRL);
89 writel(tmp, priv->base + UNIPHIER_PINCTRL_IECTRL);
94 static void uniphier_pinconf_input_enable(struct udevice *dev, unsigned pin)
96 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
98 if (priv->socdata->caps & UNIPHIER_PINCTRL_CAPS_PERPIN_IECTRL)
99 uniphier_pinconf_input_enable_perpin(dev, pin);
101 uniphier_pinconf_input_enable_legacy(dev, pin);
104 static void uniphier_pinmux_set_one(struct udevice *dev, unsigned pin,
107 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
108 unsigned reg, reg_end, shift, mask;
109 unsigned mux_bits = 8;
110 unsigned reg_stride = 4;
111 bool load_pinctrl = false;
114 /* some pins need input-enabling */
115 uniphier_pinconf_input_enable(dev, pin);
118 return; /* dedicated pin; nothing to do for pin-mux */
120 if (priv->socdata->caps & UNIPHIER_PINCTRL_CAPS_MUX_4BIT)
123 if (priv->socdata->caps & UNIPHIER_PINCTRL_CAPS_DBGMUX_SEPARATE) {
126 * Normal 4 * n shift+3:shift
127 * Debug 4 * n shift+7:shift+4
134 reg = UNIPHIER_PINCTRL_PINMUX_BASE + pin * mux_bits / 32 * reg_stride;
135 reg_end = reg + reg_stride;
136 shift = pin * mux_bits % 32;
137 mask = (1U << mux_bits) - 1;
140 * If reg_stride is greater than 4, the MSB of each pinsel shall be
141 * stored in the offset+4.
143 for (; reg < reg_end; reg += 4) {
144 tmp = readl(priv->base + reg);
145 tmp &= ~(mask << shift);
146 tmp |= (mask & muxval) << shift;
147 writel(tmp, priv->base + reg);
153 writel(1, priv->base + UNIPHIER_PINCTRL_LOAD_PINMUX);
156 static int uniphier_pinmux_group_set(struct udevice *dev,
157 unsigned group_selector,
158 unsigned func_selector)
160 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
161 const struct uniphier_pinctrl_group *grp =
162 &priv->socdata->groups[group_selector];
165 for (i = 0; i < grp->num_pins; i++)
166 uniphier_pinmux_set_one(dev, grp->pins[i], grp->muxvals[i]);
171 const struct pinctrl_ops uniphier_pinctrl_ops = {
172 .get_groups_count = uniphier_pinctrl_get_groups_count,
173 .get_group_name = uniphier_pinctrl_get_group_name,
174 .get_functions_count = uniphier_pinmux_get_functions_count,
175 .get_function_name = uniphier_pinmux_get_function_name,
176 .pinmux_group_set = uniphier_pinmux_group_set,
177 .set_state = pinctrl_generic_set_state,
180 int uniphier_pinctrl_probe(struct udevice *dev,
181 struct uniphier_pinctrl_socdata *socdata)
183 struct uniphier_pinctrl_priv *priv = dev_get_priv(dev);
186 addr = dev_get_addr(dev->parent);
187 if (addr == FDT_ADDR_T_NONE)
190 priv->base = devm_ioremap(dev, addr, SZ_4K);
194 priv->socdata = socdata;