mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-10 09:17:00 +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>
99 lines
2.1 KiB
C
99 lines
2.1 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (C) 2018 MediaTek Inc.
|
|
*
|
|
* Author: Ryder Lee <ryder.lee@mediatek.com>
|
|
* Weijie Gao <weijie.gao@mediatek.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <log.h>
|
|
#include <malloc.h>
|
|
#include <dm/lists.h>
|
|
#include <regmap.h>
|
|
#include <reset-uclass.h>
|
|
#include <syscon.h>
|
|
#include <dm/device-internal.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/err.h>
|
|
|
|
struct mediatek_reset_priv {
|
|
struct regmap *regmap;
|
|
u32 regofs;
|
|
u32 nr_resets;
|
|
};
|
|
|
|
static int mediatek_reset_assert(struct reset_ctl *reset_ctl)
|
|
{
|
|
struct mediatek_reset_priv *priv = dev_get_priv(reset_ctl->dev);
|
|
int id = reset_ctl->id;
|
|
|
|
if (id >= priv->nr_resets)
|
|
return -EINVAL;
|
|
|
|
return regmap_update_bits(priv->regmap,
|
|
priv->regofs + ((id / 32) << 2), BIT(id % 32), BIT(id % 32));
|
|
}
|
|
|
|
static int mediatek_reset_deassert(struct reset_ctl *reset_ctl)
|
|
{
|
|
struct mediatek_reset_priv *priv = dev_get_priv(reset_ctl->dev);
|
|
int id = reset_ctl->id;
|
|
|
|
if (id >= priv->nr_resets)
|
|
return -EINVAL;
|
|
|
|
return regmap_update_bits(priv->regmap,
|
|
priv->regofs + ((id / 32) << 2), BIT(id % 32), 0);
|
|
}
|
|
|
|
struct reset_ops mediatek_reset_ops = {
|
|
.rst_assert = mediatek_reset_assert,
|
|
.rst_deassert = mediatek_reset_deassert,
|
|
};
|
|
|
|
static int mediatek_reset_probe(struct udevice *dev)
|
|
{
|
|
struct mediatek_reset_priv *priv = dev_get_priv(dev);
|
|
|
|
if (!priv->regofs && !priv->nr_resets)
|
|
return -EINVAL;
|
|
|
|
priv->regmap = syscon_node_to_regmap(dev_ofnode(dev));
|
|
if (IS_ERR(priv->regmap))
|
|
return PTR_ERR(priv->regmap);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mediatek_reset_bind(struct udevice *pdev, u32 regofs, u32 num_regs)
|
|
{
|
|
struct udevice *rst_dev;
|
|
struct mediatek_reset_priv *priv;
|
|
int ret;
|
|
|
|
ret = device_bind_driver_to_node(pdev, "mediatek_reset", "reset",
|
|
dev_ofnode(pdev), &rst_dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv = malloc(sizeof(struct mediatek_reset_priv));
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
priv->regofs = regofs;
|
|
priv->nr_resets = num_regs * 32;
|
|
dev_set_priv(rst_dev, priv);
|
|
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_DRIVER(mediatek_reset) = {
|
|
.name = "mediatek_reset",
|
|
.id = UCLASS_RESET,
|
|
.probe = mediatek_reset_probe,
|
|
.ops = &mediatek_reset_ops,
|
|
.priv_auto = sizeof(struct mediatek_reset_priv),
|
|
};
|