1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2019 Rockchip Electronics Co., Ltd
9 #include <dm/pinctrl.h>
12 #include <linux/bitops.h>
14 #include "pinctrl-rockchip.h"
16 static struct rockchip_mux_route_data rk3228_mux_route_data[] = {
30 .route_val = BIT(16) | BIT(0),
37 .route_val = BIT(16 + 1),
44 .route_val = BIT(16 + 1) | BIT(1),
51 .route_val = BIT(16 + 2),
58 .route_val = BIT(16 + 2) | BIT(2),
65 .route_val = BIT(16 + 3),
72 .route_val = BIT(16 + 3) | BIT(3),
79 .route_val = BIT(16 + 4),
86 .route_val = BIT(16 + 4) | BIT(4),
93 .route_val = BIT(16 + 5),
100 .route_val = BIT(16 + 5) | BIT(5),
106 .route_offset = 0x50,
107 .route_val = BIT(16 + 7),
113 .route_offset = 0x50,
114 .route_val = BIT(16 + 7) | BIT(7),
120 .route_offset = 0x50,
121 .route_val = BIT(16 + 8),
127 .route_offset = 0x50,
128 .route_val = BIT(16 + 8) | BIT(8),
134 .route_offset = 0x50,
135 .route_val = BIT(16 + 11),
141 .route_offset = 0x50,
142 .route_val = BIT(16 + 11) | BIT(11),
146 static int rk3228_set_mux(struct rockchip_pin_bank *bank, int pin, int mux)
148 struct rockchip_pinctrl_priv *priv = bank->priv;
149 int iomux_num = (pin / 8);
150 struct regmap *regmap;
151 int reg, ret, mask, mux_type;
153 u32 data, route_reg, route_val;
155 regmap = (bank->iomux[iomux_num].type & IOMUX_SOURCE_PMU)
156 ? priv->regmap_pmu : priv->regmap_base;
158 /* get basic quadrupel of mux registers and the correct reg inside */
159 mux_type = bank->iomux[iomux_num].type;
160 reg = bank->iomux[iomux_num].offset;
161 reg += rockchip_get_mux_data(mux_type, pin, &bit, &mask);
163 if (bank->route_mask & BIT(pin)) {
164 if (rockchip_get_mux_route(bank, pin, mux, &route_reg,
166 ret = regmap_write(regmap, route_reg, route_val);
172 data = (mask << (bit + 16));
173 data |= (mux & mask) << bit;
174 ret = regmap_write(regmap, reg, data);
179 #define RK3228_PULL_OFFSET 0x100
181 static void rk3228_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
182 int pin_num, struct regmap **regmap,
185 struct rockchip_pinctrl_priv *priv = bank->priv;
187 *regmap = priv->regmap_base;
188 *reg = RK3228_PULL_OFFSET;
189 *reg += bank->bank_num * ROCKCHIP_PULL_BANK_STRIDE;
190 *reg += ((pin_num / ROCKCHIP_PULL_PINS_PER_REG) * 4);
192 *bit = (pin_num % ROCKCHIP_PULL_PINS_PER_REG);
193 *bit *= ROCKCHIP_PULL_BITS_PER_PIN;
196 static int rk3228_set_pull(struct rockchip_pin_bank *bank,
197 int pin_num, int pull)
199 struct regmap *regmap;
204 if (pull == PIN_CONFIG_BIAS_PULL_PIN_DEFAULT)
207 rk3228_calc_pull_reg_and_bit(bank, pin_num, ®map, ®, &bit);
208 type = bank->pull_type[pin_num / 8];
209 ret = rockchip_translate_pull_value(type, pull);
211 debug("unsupported pull setting %d\n", pull);
215 /* enable the write to the equivalent lower bits */
216 data = ((1 << ROCKCHIP_PULL_BITS_PER_PIN) - 1) << (bit + 16);
217 data |= (ret << bit);
218 ret = regmap_write(regmap, reg, data);
223 #define RK3228_DRV_GRF_OFFSET 0x200
225 static void rk3228_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank,
226 int pin_num, struct regmap **regmap,
229 struct rockchip_pinctrl_priv *priv = bank->priv;
231 *regmap = priv->regmap_base;
232 *reg = RK3228_DRV_GRF_OFFSET;
233 *reg += bank->bank_num * ROCKCHIP_DRV_BANK_STRIDE;
234 *reg += ((pin_num / ROCKCHIP_DRV_PINS_PER_REG) * 4);
236 *bit = (pin_num % ROCKCHIP_DRV_PINS_PER_REG);
237 *bit *= ROCKCHIP_DRV_BITS_PER_PIN;
240 static int rk3228_set_drive(struct rockchip_pin_bank *bank,
241 int pin_num, int strength)
243 struct regmap *regmap;
247 int type = bank->drv[pin_num / 8].drv_type;
249 rk3228_calc_drv_reg_and_bit(bank, pin_num, ®map, ®, &bit);
250 ret = rockchip_translate_drive_value(type, strength);
252 debug("unsupported driver strength %d\n", strength);
256 /* enable the write to the equivalent lower bits */
257 data = ((1 << ROCKCHIP_DRV_BITS_PER_PIN) - 1) << (bit + 16);
258 data |= (ret << bit);
259 ret = regmap_write(regmap, reg, data);
263 static struct rockchip_pin_bank rk3228_pin_banks[] = {
264 PIN_BANK(0, 32, "gpio0"),
265 PIN_BANK(1, 32, "gpio1"),
266 PIN_BANK(2, 32, "gpio2"),
267 PIN_BANK(3, 32, "gpio3"),
270 static struct rockchip_pin_ctrl rk3228_pin_ctrl = {
271 .pin_banks = rk3228_pin_banks,
272 .nr_banks = ARRAY_SIZE(rk3228_pin_banks),
273 .grf_mux_offset = 0x0,
274 .iomux_routes = rk3228_mux_route_data,
275 .niomux_routes = ARRAY_SIZE(rk3228_mux_route_data),
276 .set_mux = rk3228_set_mux,
277 .set_pull = rk3228_set_pull,
278 .set_drive = rk3228_set_drive,
281 static const struct udevice_id rk3228_pinctrl_ids[] = {
283 .compatible = "rockchip,rk3228-pinctrl",
284 .data = (ulong)&rk3228_pin_ctrl
289 U_BOOT_DRIVER(pinctrl_rk3228) = {
290 .name = "rockchip_rk3228_pinctrl",
291 .id = UCLASS_PINCTRL,
292 .of_match = rk3228_pinctrl_ids,
293 .priv_auto = sizeof(struct rockchip_pinctrl_priv),
294 .ops = &rockchip_pinctrl_ops,
295 #if !CONFIG_IS_ENABLED(OF_PLATDATA)
296 .bind = dm_scan_fdt_dev,
298 .probe = rockchip_pinctrl_probe,