1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2019 MediaTek Inc. All Rights Reserved.
4 *
5 * Author: Weijie Gao <weijie.gao@mediatek.com>
6 */
7
8 #include <dm.h>
9 #include <errno.h>
10 #include <log.h>
11 #include <malloc.h>
12 #include <reset-uclass.h>
13 #include <linux/bitops.h>
14 #include <linux/io.h>
15
16 struct mtmips_reset_priv {
17 void __iomem *base;
18 };
19
mtmips_reset_assert(struct reset_ctl * reset_ctl)20 static int mtmips_reset_assert(struct reset_ctl *reset_ctl)
21 {
22 struct mtmips_reset_priv *priv = dev_get_priv(reset_ctl->dev);
23
24 setbits_32(priv->base, BIT(reset_ctl->id));
25
26 return 0;
27 }
28
mtmips_reset_deassert(struct reset_ctl * reset_ctl)29 static int mtmips_reset_deassert(struct reset_ctl *reset_ctl)
30 {
31 struct mtmips_reset_priv *priv = dev_get_priv(reset_ctl->dev);
32
33 clrbits_32(priv->base, BIT(reset_ctl->id));
34
35 return 0;
36 }
37
38 static const struct reset_ops mtmips_reset_ops = {
39 .rst_assert = mtmips_reset_assert,
40 .rst_deassert = mtmips_reset_deassert,
41 };
42
mtmips_reset_probe(struct udevice * dev)43 static int mtmips_reset_probe(struct udevice *dev)
44 {
45 return 0;
46 }
47
mtmips_reset_of_to_plat(struct udevice * dev)48 static int mtmips_reset_of_to_plat(struct udevice *dev)
49 {
50 struct mtmips_reset_priv *priv = dev_get_priv(dev);
51
52 priv->base = (void __iomem *)dev_remap_addr_index(dev, 0);
53 if (!priv->base)
54 return -EINVAL;
55
56 return 0;
57 }
58
59 static const struct udevice_id mtmips_reset_ids[] = {
60 { .compatible = "mediatek,mtmips-reset" },
61 { }
62 };
63
64 U_BOOT_DRIVER(mtmips_reset) = {
65 .name = "mtmips-reset",
66 .id = UCLASS_RESET,
67 .of_match = mtmips_reset_ids,
68 .of_to_plat = mtmips_reset_of_to_plat,
69 .probe = mtmips_reset_probe,
70 .priv_auto = sizeof(struct mtmips_reset_priv),
71 .ops = &mtmips_reset_ops,
72 .flags = DM_FLAG_PRE_RELOC,
73 };
74