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
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <device/mmio.h>
#include <assert.h>
#include <console/console.h>
#include <soc/addressmap.h>
#include <soc/pmc.h>
#include <soc/power.h>
static struct tegra_pmc_regs *const pmc = (void *)TEGRA_PMC_BASE;
enum {
POWER_GATE = 0,
POWER_UNGATE = 1,
};
static int partition_powered(int id)
{
if (read32(&pmc->pwrgate_status) & (0x1 << id))
return POWER_UNGATE;
return POWER_GATE;
}
static const char *const power_gate_string[] = {
[POWER_GATE] = "Gat",
[POWER_UNGATE] = "Ungat",
};
static void power_gate_toggle_request(uint32_t id, int request)
{
printk(BIOS_INFO, "%sing power partition %d.\n",
power_gate_string[request], id);
int part_powered = partition_powered(id);
if (request == part_powered) {
printk(BIOS_INFO, "Partition %d already %sed.\n", id,
power_gate_string[request]);
return;
}
uint32_t pwrgate_toggle = read32(&pmc->pwrgate_toggle);
pwrgate_toggle &= ~(PMC_PWRGATE_TOGGLE_PARTID_MASK);
pwrgate_toggle |= (id << PMC_PWRGATE_TOGGLE_PARTID_SHIFT);
pwrgate_toggle |= PMC_PWRGATE_TOGGLE_START;
write32(&pmc->pwrgate_toggle, pwrgate_toggle);
// Wait for the request to be accepted.
while (read32(&pmc->pwrgate_toggle) & PMC_PWRGATE_TOGGLE_START)
;
printk(BIOS_INFO, "Power gate toggle request accepted.\n");
while (1) {
part_powered = partition_powered(id);
if (request == part_powered) {
printk(BIOS_INFO, "Partition %d %sed.\n", id,
power_gate_string[request]);
return;
}
}
}
void power_gate_partition(uint32_t id)
{
power_gate_toggle_request(id, POWER_GATE);
}
void power_ungate_partition(uint32_t id)
{
power_gate_toggle_request(id, POWER_UNGATE);
}
uint8_t pmc_rst_status(void)
{
return read32(&pmc->rst_status) & PMC_RST_STATUS_SOURCE_MASK;
}
static const char *pmc_rst_status_str[PMC_RST_STATUS_NUM_SOURCES] = {
[PMC_RST_STATUS_SOURCE_POR] = "POR",
[PMC_RST_STATUS_SOURCE_WATCHDOG] = "Watchdog",
[PMC_RST_STATUS_SOURCE_SENSOR] = "Sensor",
[PMC_RST_STATUS_SOURCE_SW_MAIN] = "SW Main",
[PMC_RST_STATUS_SOURCE_LP0] = "LP0",
};
void pmc_print_rst_status(void)
{
uint8_t rst_status = pmc_rst_status();
assert(rst_status < PMC_RST_STATUS_NUM_SOURCES);
printk(BIOS_INFO, "PMC Reset Status: %s\n",
pmc_rst_status_str[rst_status]);
}
static int partition_clamp_on(int id)
{
return read32(&pmc->clamp_status) & (1 << id);
}
void remove_clamps(int id)
{
if (!partition_clamp_on(id))
return;
/* Remove clamp */
write32(&pmc->remove_clamping_cmd, (1 << id));
/* Wait for clamp off */
while (partition_clamp_on(id))
;
}
void pmc_override_pwr_det(uint32_t bits, uint32_t override)
{
uint32_t val = read32(&pmc->pwr_det_val);
val &= ~bits;
val |= (override & bits);
write32(&pmc->pwr_det_val, val);
}
|
