1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2019, Linaro Limited
4 */
5
6 #include <log.h>
7 #include <malloc.h>
8 #include <asm/io.h>
9 #include <common.h>
10 #include <dm.h>
11 #include <dt-bindings/reset/ti-syscon.h>
12 #include <reset-uclass.h>
13 #include <linux/bitops.h>
14
15 struct hisi_reset_priv {
16 void __iomem *base;
17 };
18
hisi_reset_deassert(struct reset_ctl * rst)19 static int hisi_reset_deassert(struct reset_ctl *rst)
20 {
21 struct hisi_reset_priv *priv = dev_get_priv(rst->dev);
22 u32 val;
23
24 val = readl(priv->base + rst->data);
25 if (rst->polarity & DEASSERT_SET)
26 val |= BIT(rst->id);
27 else
28 val &= ~BIT(rst->id);
29 writel(val, priv->base + rst->data);
30
31 return 0;
32 }
33
hisi_reset_assert(struct reset_ctl * rst)34 static int hisi_reset_assert(struct reset_ctl *rst)
35 {
36 struct hisi_reset_priv *priv = dev_get_priv(rst->dev);
37 u32 val;
38
39 val = readl(priv->base + rst->data);
40 if (rst->polarity & ASSERT_SET)
41 val |= BIT(rst->id);
42 else
43 val &= ~BIT(rst->id);
44 writel(val, priv->base + rst->data);
45
46 return 0;
47 }
48
hisi_reset_of_xlate(struct reset_ctl * rst,struct ofnode_phandle_args * args)49 static int hisi_reset_of_xlate(struct reset_ctl *rst,
50 struct ofnode_phandle_args *args)
51 {
52 if (args->args_count != 3) {
53 debug("Invalid args_count: %d\n", args->args_count);
54 return -EINVAL;
55 }
56
57 /* Use .data field as register offset and .id field as bit shift */
58 rst->data = args->args[0];
59 rst->id = args->args[1];
60 rst->polarity = args->args[2];
61
62 return 0;
63 }
64
65 static const struct reset_ops hisi_reset_reset_ops = {
66 .of_xlate = hisi_reset_of_xlate,
67 .rst_assert = hisi_reset_assert,
68 .rst_deassert = hisi_reset_deassert,
69 };
70
71 static const struct udevice_id hisi_reset_ids[] = {
72 { .compatible = "hisilicon,hi3798cv200-reset" },
73 { }
74 };
75
hisi_reset_probe(struct udevice * dev)76 static int hisi_reset_probe(struct udevice *dev)
77 {
78 struct hisi_reset_priv *priv = dev_get_priv(dev);
79
80 priv->base = dev_remap_addr(dev);
81 if (!priv->base)
82 return -ENOMEM;
83
84 return 0;
85 }
86
87 U_BOOT_DRIVER(hisi_reset) = {
88 .name = "hisilicon_reset",
89 .id = UCLASS_RESET,
90 .of_match = hisi_reset_ids,
91 .ops = &hisi_reset_reset_ops,
92 .probe = hisi_reset_probe,
93 .priv_auto = sizeof(struct hisi_reset_priv),
94 };
95