mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-09-19 21:01:51 +02:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commit c8ffd1356d42223cbb8c86280a083cc3c93e6426, reversing changes made to 2ee6f3a5f7550de3599faef9704e166e5dcace35. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
89 lines
1.9 KiB
C
89 lines
1.9 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (C) 2019 MediaTek Inc. All Rights Reserved.
|
|
*
|
|
* Author: Weijie Gao <weijie.gao@mediatek.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <malloc.h>
|
|
#include <dm/pinctrl.h>
|
|
#include <linux/io.h>
|
|
|
|
#include "pinctrl-mtmips-common.h"
|
|
|
|
void mtmips_pinctrl_reg_set(struct mtmips_pinctrl_priv *priv,
|
|
u32 reg, u32 shift, u32 mask, u32 value)
|
|
{
|
|
u32 val;
|
|
|
|
val = readl(priv->base + reg);
|
|
val &= ~(mask << shift);
|
|
val |= value << shift;
|
|
writel(val, priv->base + reg);
|
|
}
|
|
|
|
int mtmips_get_functions_count(struct udevice *dev)
|
|
{
|
|
struct mtmips_pinctrl_priv *priv = dev_get_priv(dev);
|
|
|
|
return priv->nfuncs;
|
|
}
|
|
|
|
const char *mtmips_get_function_name(struct udevice *dev, unsigned int selector)
|
|
{
|
|
struct mtmips_pinctrl_priv *priv = dev_get_priv(dev);
|
|
|
|
return priv->funcs[selector]->name;
|
|
}
|
|
|
|
int mtmips_pinmux_group_set(struct udevice *dev, unsigned int group_selector,
|
|
unsigned int func_selector)
|
|
{
|
|
struct mtmips_pinctrl_priv *priv = dev_get_priv(dev);
|
|
const struct mtmips_pmx_group *grp = &priv->groups[group_selector];
|
|
const struct mtmips_pmx_func *func = priv->funcs[func_selector];
|
|
int i;
|
|
|
|
if (!grp->nfuncs)
|
|
return 0;
|
|
|
|
for (i = 0; i < grp->nfuncs; i++) {
|
|
if (!strcmp(grp->funcs[i].name, func->name)) {
|
|
mtmips_pinctrl_reg_set(priv, grp->reg, grp->shift,
|
|
grp->mask, grp->funcs[i].value);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
int mtmips_pinctrl_probe(struct mtmips_pinctrl_priv *priv, u32 ngroups,
|
|
const struct mtmips_pmx_group *groups)
|
|
{
|
|
int i, j, n;
|
|
|
|
priv->ngroups = ngroups;
|
|
priv->groups = groups;
|
|
|
|
priv->nfuncs = 0;
|
|
|
|
for (i = 0; i < ngroups; i++)
|
|
priv->nfuncs += groups[i].nfuncs;
|
|
|
|
priv->funcs = malloc(priv->nfuncs * sizeof(*priv->funcs));
|
|
if (!priv->funcs)
|
|
return -ENOMEM;
|
|
|
|
n = 0;
|
|
|
|
for (i = 0; i < ngroups; i++) {
|
|
for (j = 0; j < groups[i].nfuncs; j++)
|
|
priv->funcs[n++] = &groups[i].funcs[j];
|
|
}
|
|
|
|
return 0;
|
|
}
|