1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
|
/*
* Copyright (c) 2006-2023, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2023-02-25 GuEe-GUI the first version
*/
#include <rtthread.h>
#include <rtdevice.h>
#define DBG_TAG "mfd.bcm2835-pm"
#define DBG_LVL DBG_INFO
#include <rtdbg.h>
#include <bcm2835-pm.h>
static rt_err_t bcm2835_pm_probe(struct rt_platform_device *pdev)
{
rt_err_t err;
rt_bool_t is_2712 = RT_FALSE;
struct rt_device *dev = &pdev->parent;
struct rt_bus *bus = dev->bus;
struct bcm2835_pm *pm = rt_malloc(sizeof(*pm));
if (!pm)
{
return -RT_ENOMEM;
}
#ifdef RT_USING_OFW
is_2712 = rt_ofw_node_is_compatible(dev->ofw_node, "brcm,bcm2712-pm");
if (rt_ofw_prop_read_bool(dev->ofw_node, "reg-names"))
{
if (!(pm->base = rt_dm_dev_iomap_by_name(dev, "pm")))
{
err = -RT_EIO;
goto _fail;
}
pm->asb = rt_dm_dev_iomap_by_name(dev, "asb");
pm->rpivid_asb = rt_dm_dev_iomap_by_name(dev, "rpivid_asb");
}
else
#endif /* RT_USING_OFW */
{
if (!(pm->base = rt_dm_dev_iomap(dev, 0)))
{
err = -RT_EIO;
goto _fail;
}
pm->asb = rt_dm_dev_iomap(dev, 1);
pm->rpivid_asb = rt_dm_dev_iomap(dev, 2);
}
pm->ofw_node = dev->ofw_node;
pdev->name = "bcm2835-wdt";
pdev->priv = pm;
/* Ask bus to check drivers' name */
pdev->parent.ofw_node = RT_NULL;
rt_bus_remove_device(dev);
rt_bus_add_device(bus, dev);
if (pm->asb || is_2712)
{
pdev = rt_calloc(1, sizeof(*pdev));
if (pdev)
{
pdev->name = "bcm2835-power";
pdev->priv = pm;
rt_bus_add_device(bus, &pdev->parent);
}
else
{
LOG_W("Power will not register");
}
}
/* No Error, No success */
return 1;
_fail:
rt_free(pm);
return err;
}
static const struct rt_ofw_node_id bcm2835_pm_ofw_ids[] =
{
{ .compatible = "brcm,bcm2835-pm-wdt", },
{ .compatible = "brcm,bcm2835-pm", },
{ .compatible = "brcm,bcm2711-pm", },
{ .compatible = "brcm,bcm2712-pm", },
{ /* sentinel */ }
};
static struct rt_platform_driver bcm2835_pm_driver =
{
.name = "pm-bcm2835",
.ids = bcm2835_pm_ofw_ids,
.probe = bcm2835_pm_probe,
};
static int bcm2835_pm_register(void)
{
rt_platform_driver_register(&bcm2835_pm_driver);
return 0;
}
INIT_SUBSYS_EXPORT(bcm2835_pm_register);
|
