1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (C) 2019 MediaTek Inc. All Rights Reserved.
5 * Author: Weijie Gao <weijie.gao@mediatek.com>
11 #include <dm/pinctrl.h>
14 #include "pinctrl-mtmips-common.h"
16 static void mtmips_pinctrl_reg_set(struct mtmips_pinctrl_priv *priv,
17 u32 reg, u32 shift, u32 mask, u32 value)
21 val = readl(priv->base + reg);
22 val &= ~(mask << shift);
23 val |= value << shift;
24 writel(val, priv->base + reg);
27 int mtmips_get_functions_count(struct udevice *dev)
29 struct mtmips_pinctrl_priv *priv = dev_get_priv(dev);
34 const char *mtmips_get_function_name(struct udevice *dev, unsigned int selector)
36 struct mtmips_pinctrl_priv *priv = dev_get_priv(dev);
38 return priv->funcs[selector]->name;
41 int mtmips_pinmux_group_set(struct udevice *dev, unsigned int group_selector,
42 unsigned int func_selector)
44 struct mtmips_pinctrl_priv *priv = dev_get_priv(dev);
45 const struct mtmips_pmx_group *grp = &priv->groups[group_selector];
46 const struct mtmips_pmx_func *func = priv->funcs[func_selector];
52 for (i = 0; i < grp->nfuncs; i++) {
53 if (!strcmp(grp->funcs[i].name, func->name)) {
54 mtmips_pinctrl_reg_set(priv, grp->reg, grp->shift,
55 grp->mask, grp->funcs[i].value);
63 int mtmips_pinctrl_probe(struct mtmips_pinctrl_priv *priv, u32 ngroups,
64 const struct mtmips_pmx_group *groups)
68 priv->ngroups = ngroups;
69 priv->groups = groups;
73 for (i = 0; i < ngroups; i++)
74 priv->nfuncs += groups[i].nfuncs;
76 priv->funcs = malloc(priv->nfuncs * sizeof(*priv->funcs));
82 for (i = 0; i < ngroups; i++) {
83 for (j = 0; j < groups[i].nfuncs; j++)
84 priv->funcs[n++] = &groups[i].funcs[j];