1
2
3
4
5
6
7
8
9#include <common.h>
10#include <dm.h>
11#include <errno.h>
12#include <reset-uclass.h>
13#include <asm/io.h>
14
15#define MAX_RESETS 32
16
17struct bcm6345_reset_priv {
18 void __iomem *regs;
19};
20
21static int bcm6345_reset_assert(struct reset_ctl *rst)
22{
23 struct bcm6345_reset_priv *priv = dev_get_priv(rst->dev);
24
25 clrbits_be32(priv->regs, BIT(rst->id));
26 mdelay(20);
27
28 return 0;
29}
30
31static int bcm6345_reset_deassert(struct reset_ctl *rst)
32{
33 struct bcm6345_reset_priv *priv = dev_get_priv(rst->dev);
34
35 setbits_be32(priv->regs, BIT(rst->id));
36 mdelay(20);
37
38 return 0;
39}
40
41static int bcm6345_reset_free(struct reset_ctl *rst)
42{
43 return 0;
44}
45
46static int bcm6345_reset_request(struct reset_ctl *rst)
47{
48 if (rst->id >= MAX_RESETS)
49 return -EINVAL;
50
51 return bcm6345_reset_assert(rst);
52}
53
54struct reset_ops bcm6345_reset_reset_ops = {
55 .free = bcm6345_reset_free,
56 .request = bcm6345_reset_request,
57 .rst_assert = bcm6345_reset_assert,
58 .rst_deassert = bcm6345_reset_deassert,
59};
60
61static const struct udevice_id bcm6345_reset_ids[] = {
62 { .compatible = "brcm,bcm6345-reset" },
63 { }
64};
65
66static int bcm6345_reset_probe(struct udevice *dev)
67{
68 struct bcm6345_reset_priv *priv = dev_get_priv(dev);
69
70 priv->regs = dev_remap_addr(dev);
71 if (!priv->regs)
72 return -EINVAL;
73
74 return 0;
75}
76
77U_BOOT_DRIVER(bcm6345_reset) = {
78 .name = "bcm6345-reset",
79 .id = UCLASS_RESET,
80 .of_match = bcm6345_reset_ids,
81 .ops = &bcm6345_reset_reset_ops,
82 .probe = bcm6345_reset_probe,
83 .priv_auto_alloc_size = sizeof(struct bcm6345_reset_priv),
84};
85