tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
soc: amlogic: Add support for Secure power domains controller
Add support for the Amlogic Secure Power controller. In A1/C1 series, power
control registers are in secure domain, and should be accessed by smc.
Signed-off-by: Jianxin Pan <jianxin.pan@amlogic.com>
Signed-off-by: Kevin Hilman <khilman@baylibre.com>
Link: https://lore.kernel.org/r/1579087831-94965-4-git-send-email-jianxin.pan@amlogic.com
authored by
Jianxin Pan
and committed by
Kevin Hilman
b3dde501
165b5fb2
+218
+13
drivers/soc/amlogic/Kconfig
+13
drivers/soc/amlogic/Kconfig
···
48
48
Say yes to expose Amlogic Meson Everything-Else Power Domains as
49
49
Generic Power Domains.
50
50
51
+
config MESON_SECURE_PM_DOMAINS
52
+
bool "Amlogic Meson Secure Power Domains driver"
53
+
depends on ARCH_MESON || COMPILE_TEST
54
+
depends on PM && OF
55
+
depends on HAVE_ARM_SMCCC
56
+
default ARCH_MESON
57
+
select PM_GENERIC_DOMAINS
58
+
select PM_GENERIC_DOMAINS_OF
59
+
help
60
+
Support for the power controller on Amlogic A1/C1 series.
61
+
Say yes to expose Amlogic Meson Secure Power Domains as Generic
62
+
Power Domains.
63
+
51
64
config MESON_MX_SOCINFO
52
65
bool "Amlogic Meson MX SoC Information driver"
53
66
depends on ARCH_MESON || COMPILE_TEST
+1
drivers/soc/amlogic/Makefile
+1
drivers/soc/amlogic/Makefile
+204
drivers/soc/amlogic/meson-secure-pwrc.c
+204
drivers/soc/amlogic/meson-secure-pwrc.c
···
1
+
// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
2
+
/*
3
+
* Copyright (c) 2019 Amlogic, Inc.
4
+
* Author: Jianxin Pan <jianxin.pan@amlogic.com>
5
+
*/
6
+
7
+
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
8
+
9
+
#include <linux/io.h>
10
+
#include <linux/of_device.h>
11
+
#include <linux/platform_device.h>
12
+
#include <linux/pm_domain.h>
13
+
#include <dt-bindings/power/meson-a1-power.h>
14
+
#include <linux/arm-smccc.h>
15
+
#include <linux/firmware/meson/meson_sm.h>
16
+
17
+
#define PWRC_ON 1
18
+
#define PWRC_OFF 0
19
+
20
+
struct meson_secure_pwrc_domain {
21
+
struct generic_pm_domain base;
22
+
unsigned int index;
23
+
struct meson_secure_pwrc *pwrc;
24
+
};
25
+
26
+
struct meson_secure_pwrc {
27
+
struct meson_secure_pwrc_domain *domains;
28
+
struct genpd_onecell_data xlate;
29
+
struct meson_sm_firmware *fw;
30
+
};
31
+
32
+
struct meson_secure_pwrc_domain_desc {
33
+
unsigned int index;
34
+
unsigned int flags;
35
+
char *name;
36
+
bool (*is_off)(struct meson_secure_pwrc_domain *pwrc_domain);
37
+
};
38
+
39
+
struct meson_secure_pwrc_domain_data {
40
+
unsigned int count;
41
+
struct meson_secure_pwrc_domain_desc *domains;
42
+
};
43
+
44
+
static bool pwrc_secure_is_off(struct meson_secure_pwrc_domain *pwrc_domain)
45
+
{
46
+
int is_off = 1;
47
+
48
+
if (meson_sm_call(pwrc_domain->pwrc->fw, SM_A1_PWRC_GET, &is_off,
49
+
pwrc_domain->index, 0, 0, 0, 0) < 0)
50
+
pr_err("failed to get power domain status\n");
51
+
52
+
return is_off;
53
+
}
54
+
55
+
static int meson_secure_pwrc_off(struct generic_pm_domain *domain)
56
+
{
57
+
int ret = 0;
58
+
struct meson_secure_pwrc_domain *pwrc_domain =
59
+
container_of(domain, struct meson_secure_pwrc_domain, base);
60
+
61
+
if (meson_sm_call(pwrc_domain->pwrc->fw, SM_A1_PWRC_SET, NULL,
62
+
pwrc_domain->index, PWRC_OFF, 0, 0, 0) < 0) {
63
+
pr_err("failed to set power domain off\n");
64
+
ret = -EINVAL;
65
+
}
66
+
67
+
return ret;
68
+
}
69
+
70
+
static int meson_secure_pwrc_on(struct generic_pm_domain *domain)
71
+
{
72
+
int ret = 0;
73
+
struct meson_secure_pwrc_domain *pwrc_domain =
74
+
container_of(domain, struct meson_secure_pwrc_domain, base);
75
+
76
+
if (meson_sm_call(pwrc_domain->pwrc->fw, SM_A1_PWRC_SET, NULL,
77
+
pwrc_domain->index, PWRC_ON, 0, 0, 0) < 0) {
78
+
pr_err("failed to set power domain on\n");
79
+
ret = -EINVAL;
80
+
}
81
+
82
+
return ret;
83
+
}
84
+
85
+
#define SEC_PD(__name, __flag) \
86
+
[PWRC_##__name##_ID] = \
87
+
{ \
88
+
.name = #__name, \
89
+
.index = PWRC_##__name##_ID, \
90
+
.is_off = pwrc_secure_is_off, \
91
+
.flags = __flag, \
92
+
}
93
+
94
+
static struct meson_secure_pwrc_domain_desc a1_pwrc_domains[] = {
95
+
SEC_PD(DSPA, 0),
96
+
SEC_PD(DSPB, 0),
97
+
/* UART should keep working in ATF after suspend and before resume */
98
+
SEC_PD(UART, GENPD_FLAG_ALWAYS_ON),
99
+
/* DMC is for DDR PHY ana/dig and DMC, and should be always on */
100
+
SEC_PD(DMC, GENPD_FLAG_ALWAYS_ON),
101
+
SEC_PD(I2C, 0),
102
+
SEC_PD(PSRAM, 0),
103
+
SEC_PD(ACODEC, 0),
104
+
SEC_PD(AUDIO, 0),
105
+
SEC_PD(OTP, 0),
106
+
SEC_PD(DMA, 0),
107
+
SEC_PD(SD_EMMC, 0),
108
+
SEC_PD(RAMA, 0),
109
+
/* SRAMB is used as ATF runtime memory, and should be always on */
110
+
SEC_PD(RAMB, GENPD_FLAG_ALWAYS_ON),
111
+
SEC_PD(IR, 0),
112
+
SEC_PD(SPICC, 0),
113
+
SEC_PD(SPIFC, 0),
114
+
SEC_PD(USB, 0),
115
+
/* NIC is for the Arm NIC-400 interconnect, and should be always on */
116
+
SEC_PD(NIC, GENPD_FLAG_ALWAYS_ON),
117
+
SEC_PD(PDMIN, 0),
118
+
SEC_PD(RSA, 0),
119
+
};
120
+
121
+
static int meson_secure_pwrc_probe(struct platform_device *pdev)
122
+
{
123
+
int i;
124
+
struct device_node *sm_np;
125
+
struct meson_secure_pwrc *pwrc;
126
+
const struct meson_secure_pwrc_domain_data *match;
127
+
128
+
match = of_device_get_match_data(&pdev->dev);
129
+
if (!match) {
130
+
dev_err(&pdev->dev, "failed to get match data\n");
131
+
return -ENODEV;
132
+
}
133
+
134
+
sm_np = of_find_compatible_node(NULL, NULL, "amlogic,meson-gxbb-sm");
135
+
if (!sm_np) {
136
+
dev_err(&pdev->dev, "no secure-monitor node\n");
137
+
return -ENODEV;
138
+
}
139
+
140
+
pwrc = devm_kzalloc(&pdev->dev, sizeof(*pwrc), GFP_KERNEL);
141
+
if (!pwrc)
142
+
return -ENOMEM;
143
+
144
+
pwrc->fw = meson_sm_get(sm_np);
145
+
of_node_put(sm_np);
146
+
if (!pwrc->fw)
147
+
return -EPROBE_DEFER;
148
+
149
+
pwrc->xlate.domains = devm_kcalloc(&pdev->dev, match->count,
150
+
sizeof(*pwrc->xlate.domains),
151
+
GFP_KERNEL);
152
+
if (!pwrc->xlate.domains)
153
+
return -ENOMEM;
154
+
155
+
pwrc->domains = devm_kcalloc(&pdev->dev, match->count,
156
+
sizeof(*pwrc->domains), GFP_KERNEL);
157
+
if (!pwrc->domains)
158
+
return -ENOMEM;
159
+
160
+
pwrc->xlate.num_domains = match->count;
161
+
platform_set_drvdata(pdev, pwrc);
162
+
163
+
for (i = 0 ; i < match->count ; ++i) {
164
+
struct meson_secure_pwrc_domain *dom = &pwrc->domains[i];
165
+
166
+
if (!match->domains[i].index)
167
+
continue;
168
+
169
+
dom->pwrc = pwrc;
170
+
dom->index = match->domains[i].index;
171
+
dom->base.name = match->domains[i].name;
172
+
dom->base.flags = match->domains[i].flags;
173
+
dom->base.power_on = meson_secure_pwrc_on;
174
+
dom->base.power_off = meson_secure_pwrc_off;
175
+
176
+
pm_genpd_init(&dom->base, NULL, match->domains[i].is_off(dom));
177
+
178
+
pwrc->xlate.domains[i] = &dom->base;
179
+
}
180
+
181
+
return of_genpd_add_provider_onecell(pdev->dev.of_node, &pwrc->xlate);
182
+
}
183
+
184
+
static struct meson_secure_pwrc_domain_data meson_secure_a1_pwrc_data = {
185
+
.domains = a1_pwrc_domains,
186
+
.count = ARRAY_SIZE(a1_pwrc_domains),
187
+
};
188
+
189
+
static const struct of_device_id meson_secure_pwrc_match_table[] = {
190
+
{
191
+
.compatible = "amlogic,meson-a1-pwrc",
192
+
.data = &meson_secure_a1_pwrc_data,
193
+
},
194
+
{ /* sentinel */ }
195
+
};
196
+
197
+
static struct platform_driver meson_secure_pwrc_driver = {
198
+
.probe = meson_secure_pwrc_probe,
199
+
.driver = {
200
+
.name = "meson_secure_pwrc",
201
+
.of_match_table = meson_secure_pwrc_match_table,
202
+
},
203
+
};
204
+
builtin_platform_driver(meson_secure_pwrc_driver);