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