mirror of
https://xff.cz/git/u-boot/
synced 2025-10-01 23:41:18 +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 commitc8ffd1356d, reversing changes made to2ee6f3a5f7. 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;
|
|
}
|