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.h>
11 #include <linux/platform_device.h>
12 #include <linux/pm_domain.h>
13 #include <dt-bindings/power/meson-a1-power.h>
14 #include <dt-bindings/power/amlogic,c3-pwrc.h>
15 #include <dt-bindings/power/meson-s4-power.h>
16 #include <linux/arm-smccc.h>
17 #include <linux/firmware/meson/meson_sm.h>
18 #include <linux/module.h>
19 
20 #define PWRC_ON		1
21 #define PWRC_OFF	0
22 
23 struct meson_secure_pwrc_domain {
24 	struct generic_pm_domain base;
25 	unsigned int index;
26 	struct meson_secure_pwrc *pwrc;
27 };
28 
29 struct meson_secure_pwrc {
30 	struct meson_secure_pwrc_domain *domains;
31 	struct genpd_onecell_data xlate;
32 	struct meson_sm_firmware *fw;
33 };
34 
35 struct meson_secure_pwrc_domain_desc {
36 	unsigned int index;
37 	unsigned int flags;
38 	char *name;
39 	bool (*is_off)(struct meson_secure_pwrc_domain *pwrc_domain);
40 };
41 
42 struct meson_secure_pwrc_domain_data {
43 	unsigned int count;
44 	struct meson_secure_pwrc_domain_desc *domains;
45 };
46 
pwrc_secure_is_off(struct meson_secure_pwrc_domain * pwrc_domain)47 static bool pwrc_secure_is_off(struct meson_secure_pwrc_domain *pwrc_domain)
48 {
49 	int is_off = 1;
50 
51 	if (meson_sm_call(pwrc_domain->pwrc->fw, SM_A1_PWRC_GET, &is_off,
52 			  pwrc_domain->index, 0, 0, 0, 0) < 0)
53 		pr_err("failed to get power domain status\n");
54 
55 	return is_off;
56 }
57 
meson_secure_pwrc_off(struct generic_pm_domain * domain)58 static int meson_secure_pwrc_off(struct generic_pm_domain *domain)
59 {
60 	int ret = 0;
61 	struct meson_secure_pwrc_domain *pwrc_domain =
62 		container_of(domain, struct meson_secure_pwrc_domain, base);
63 
64 	if (meson_sm_call(pwrc_domain->pwrc->fw, SM_A1_PWRC_SET, NULL,
65 			  pwrc_domain->index, PWRC_OFF, 0, 0, 0) < 0) {
66 		pr_err("failed to set power domain off\n");
67 		ret = -EINVAL;
68 	}
69 
70 	return ret;
71 }
72 
meson_secure_pwrc_on(struct generic_pm_domain * domain)73 static int meson_secure_pwrc_on(struct generic_pm_domain *domain)
74 {
75 	int ret = 0;
76 	struct meson_secure_pwrc_domain *pwrc_domain =
77 		container_of(domain, struct meson_secure_pwrc_domain, base);
78 
79 	if (meson_sm_call(pwrc_domain->pwrc->fw, SM_A1_PWRC_SET, NULL,
80 			  pwrc_domain->index, PWRC_ON, 0, 0, 0) < 0) {
81 		pr_err("failed to set power domain on\n");
82 		ret = -EINVAL;
83 	}
84 
85 	return ret;
86 }
87 
88 #define SEC_PD(__name, __flag)			\
89 [PWRC_##__name##_ID] =				\
90 {						\
91 	.name = #__name,			\
92 	.index = PWRC_##__name##_ID,		\
93 	.is_off = pwrc_secure_is_off,	\
94 	.flags = __flag,			\
95 }
96 
97 static struct meson_secure_pwrc_domain_desc a1_pwrc_domains[] = {
98 	SEC_PD(DSPA,	0),
99 	SEC_PD(DSPB,	0),
100 	/* UART should keep working in ATF after suspend and before resume */
101 	SEC_PD(UART,	GENPD_FLAG_ALWAYS_ON),
102 	/* DMC is for DDR PHY ana/dig and DMC, and should be always on */
103 	SEC_PD(DMC,	GENPD_FLAG_ALWAYS_ON),
104 	SEC_PD(I2C,	0),
105 	SEC_PD(PSRAM,	0),
106 	SEC_PD(ACODEC,	0),
107 	SEC_PD(AUDIO,	0),
108 	SEC_PD(OTP,	0),
109 	SEC_PD(DMA,	GENPD_FLAG_ALWAYS_ON | GENPD_FLAG_IRQ_SAFE),
110 	SEC_PD(SD_EMMC,	0),
111 	SEC_PD(RAMA,	0),
112 	/* SRAMB is used as ATF runtime memory, and should be always on */
113 	SEC_PD(RAMB,	GENPD_FLAG_ALWAYS_ON),
114 	SEC_PD(IR,	0),
115 	SEC_PD(SPICC,	0),
116 	SEC_PD(SPIFC,	0),
117 	SEC_PD(USB,	0),
118 	/* NIC is for the Arm NIC-400 interconnect, and should be always on */
119 	SEC_PD(NIC,	GENPD_FLAG_ALWAYS_ON),
120 	SEC_PD(PDMIN,	0),
121 	SEC_PD(RSA,	0),
122 };
123 
124 static struct meson_secure_pwrc_domain_desc c3_pwrc_domains[] = {
125 	SEC_PD(C3_NNA,	0),
126 	SEC_PD(C3_AUDIO,	GENPD_FLAG_ALWAYS_ON),
127 	SEC_PD(C3_SDIOA,	GENPD_FLAG_ALWAYS_ON),
128 	SEC_PD(C3_EMMC,	GENPD_FLAG_ALWAYS_ON),
129 	SEC_PD(C3_USB_COMB, GENPD_FLAG_ALWAYS_ON),
130 	SEC_PD(C3_SDCARD,	GENPD_FLAG_ALWAYS_ON),
131 	SEC_PD(C3_ETH,	GENPD_FLAG_ALWAYS_ON),
132 	SEC_PD(C3_GE2D,	GENPD_FLAG_ALWAYS_ON),
133 	SEC_PD(C3_CVE,	GENPD_FLAG_ALWAYS_ON),
134 	SEC_PD(C3_GDC_WRAP,	GENPD_FLAG_ALWAYS_ON),
135 	SEC_PD(C3_ISP_TOP,		GENPD_FLAG_ALWAYS_ON),
136 	SEC_PD(C3_MIPI_ISP_WRAP, GENPD_FLAG_ALWAYS_ON),
137 	SEC_PD(C3_VCODEC,	0),
138 };
139 
140 static struct meson_secure_pwrc_domain_desc s4_pwrc_domains[] = {
141 	SEC_PD(S4_DOS_HEVC,	0),
142 	SEC_PD(S4_DOS_VDEC,	0),
143 	SEC_PD(S4_VPU_HDMI,	0),
144 	SEC_PD(S4_USB_COMB,	0),
145 	SEC_PD(S4_GE2D,		0),
146 	/* ETH is for ethernet online wakeup, and should be always on */
147 	SEC_PD(S4_ETH,		GENPD_FLAG_ALWAYS_ON),
148 	SEC_PD(S4_DEMOD,	0),
149 	SEC_PD(S4_AUDIO,	0),
150 };
151 
meson_secure_pwrc_probe(struct platform_device * pdev)152 static int meson_secure_pwrc_probe(struct platform_device *pdev)
153 {
154 	int i;
155 	struct device_node *sm_np;
156 	struct meson_secure_pwrc *pwrc;
157 	const struct meson_secure_pwrc_domain_data *match;
158 
159 	match = of_device_get_match_data(&pdev->dev);
160 	if (!match) {
161 		dev_err(&pdev->dev, "failed to get match data\n");
162 		return -ENODEV;
163 	}
164 
165 	sm_np = of_find_compatible_node(NULL, NULL, "amlogic,meson-gxbb-sm");
166 	if (!sm_np) {
167 		dev_err(&pdev->dev, "no secure-monitor node\n");
168 		return -ENODEV;
169 	}
170 
171 	pwrc = devm_kzalloc(&pdev->dev, sizeof(*pwrc), GFP_KERNEL);
172 	if (!pwrc) {
173 		of_node_put(sm_np);
174 		return -ENOMEM;
175 	}
176 
177 	pwrc->fw = meson_sm_get(sm_np);
178 	of_node_put(sm_np);
179 	if (!pwrc->fw)
180 		return -EPROBE_DEFER;
181 
182 	pwrc->xlate.domains = devm_kcalloc(&pdev->dev, match->count,
183 					   sizeof(*pwrc->xlate.domains),
184 					   GFP_KERNEL);
185 	if (!pwrc->xlate.domains)
186 		return -ENOMEM;
187 
188 	pwrc->domains = devm_kcalloc(&pdev->dev, match->count,
189 				     sizeof(*pwrc->domains), GFP_KERNEL);
190 	if (!pwrc->domains)
191 		return -ENOMEM;
192 
193 	pwrc->xlate.num_domains = match->count;
194 	platform_set_drvdata(pdev, pwrc);
195 
196 	for (i = 0 ; i < match->count ; ++i) {
197 		struct meson_secure_pwrc_domain *dom = &pwrc->domains[i];
198 
199 		if (!match->domains[i].name)
200 			continue;
201 
202 		dom->pwrc = pwrc;
203 		dom->index = match->domains[i].index;
204 		dom->base.name = match->domains[i].name;
205 		dom->base.flags = match->domains[i].flags;
206 		dom->base.power_on = meson_secure_pwrc_on;
207 		dom->base.power_off = meson_secure_pwrc_off;
208 
209 		pm_genpd_init(&dom->base, NULL, match->domains[i].is_off(dom));
210 
211 		pwrc->xlate.domains[i] = &dom->base;
212 	}
213 
214 	return of_genpd_add_provider_onecell(pdev->dev.of_node, &pwrc->xlate);
215 }
216 
217 static struct meson_secure_pwrc_domain_data meson_secure_a1_pwrc_data = {
218 	.domains = a1_pwrc_domains,
219 	.count = ARRAY_SIZE(a1_pwrc_domains),
220 };
221 
222 static struct meson_secure_pwrc_domain_data amlogic_secure_c3_pwrc_data = {
223 	.domains = c3_pwrc_domains,
224 	.count = ARRAY_SIZE(c3_pwrc_domains),
225 };
226 
227 static struct meson_secure_pwrc_domain_data meson_secure_s4_pwrc_data = {
228 	.domains = s4_pwrc_domains,
229 	.count = ARRAY_SIZE(s4_pwrc_domains),
230 };
231 
232 static const struct of_device_id meson_secure_pwrc_match_table[] = {
233 	{
234 		.compatible = "amlogic,meson-a1-pwrc",
235 		.data = &meson_secure_a1_pwrc_data,
236 	},
237 	{
238 		.compatible = "amlogic,c3-pwrc",
239 		.data = &amlogic_secure_c3_pwrc_data,
240 	},
241 	{
242 		.compatible = "amlogic,meson-s4-pwrc",
243 		.data = &meson_secure_s4_pwrc_data,
244 	},
245 	{ /* sentinel */ }
246 };
247 MODULE_DEVICE_TABLE(of, meson_secure_pwrc_match_table);
248 
249 static struct platform_driver meson_secure_pwrc_driver = {
250 	.probe = meson_secure_pwrc_probe,
251 	.driver = {
252 		.name		= "meson_secure_pwrc",
253 		.of_match_table	= meson_secure_pwrc_match_table,
254 	},
255 };
256 module_platform_driver(meson_secure_pwrc_driver);
257 MODULE_LICENSE("Dual MIT/GPL");
258