1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (C) 2018 MediaTek Inc.
5 * Author: Ryder Lee <ryder.lee@mediatek.com>
6 * Weijie Gao <weijie.gao@mediatek.com>
15 #include <reset-uclass.h>
17 #include <linux/bitops.h>
18 #include <linux/err.h>
20 struct mediatek_reset_priv {
21 struct regmap *regmap;
26 static int mediatek_reset_request(struct reset_ctl *reset_ctl)
31 static int mediatek_reset_free(struct reset_ctl *reset_ctl)
36 static int mediatek_reset_assert(struct reset_ctl *reset_ctl)
38 struct mediatek_reset_priv *priv = dev_get_priv(reset_ctl->dev);
39 int id = reset_ctl->id;
41 if (id >= priv->nr_resets)
44 return regmap_update_bits(priv->regmap,
45 priv->regofs + ((id / 32) << 2), BIT(id % 32), BIT(id % 32));
48 static int mediatek_reset_deassert(struct reset_ctl *reset_ctl)
50 struct mediatek_reset_priv *priv = dev_get_priv(reset_ctl->dev);
51 int id = reset_ctl->id;
53 if (id >= priv->nr_resets)
56 return regmap_update_bits(priv->regmap,
57 priv->regofs + ((id / 32) << 2), BIT(id % 32), 0);
60 struct reset_ops mediatek_reset_ops = {
61 .request = mediatek_reset_request,
62 .rfree = mediatek_reset_free,
63 .rst_assert = mediatek_reset_assert,
64 .rst_deassert = mediatek_reset_deassert,
67 static int mediatek_reset_probe(struct udevice *dev)
69 struct mediatek_reset_priv *priv = dev_get_priv(dev);
71 if (!priv->regofs && !priv->nr_resets)
74 priv->regmap = syscon_node_to_regmap(dev_ofnode(dev));
75 if (IS_ERR(priv->regmap))
76 return PTR_ERR(priv->regmap);
81 int mediatek_reset_bind(struct udevice *pdev, u32 regofs, u32 num_regs)
83 struct udevice *rst_dev;
84 struct mediatek_reset_priv *priv;
87 ret = device_bind_driver_to_node(pdev, "mediatek_reset", "reset",
88 dev_ofnode(pdev), &rst_dev);
92 priv = malloc(sizeof(struct mediatek_reset_priv));
93 priv->regofs = regofs;
94 priv->nr_resets = num_regs * 32;
100 U_BOOT_DRIVER(mediatek_reset) = {
101 .name = "mediatek_reset",
103 .probe = mediatek_reset_probe,
104 .ops = &mediatek_reset_ops,
105 .priv_auto_alloc_size = sizeof(struct mediatek_reset_priv),