1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved. */
5 #include <linux/init.h>
6 #include <linux/kernel.h>
7 #include <linux/mutex.h>
8 #include <linux/pm_domain.h>
10 #include <linux/of_device.h>
11 #include <linux/platform_device.h>
12 #include <linux/pm_opp.h>
13 #include <linux/soc/qcom/smd-rpm.h>
15 #include <dt-bindings/power/qcom-rpmpd.h>
17 #define domain_to_rpmpd(domain) container_of(domain, struct rpmpd, pd)
20 #define RPMPD_SMPA 0x61706d73
21 #define RPMPD_LDOA 0x616f646c
24 #define KEY_CORNER 0x6e726f63 /* corn */
25 #define KEY_ENABLE 0x6e657773 /* swen */
26 #define KEY_FLOOR_CORNER 0x636676 /* vfc */
28 #define MAX_RPMPD_STATE 6
30 #define DEFINE_RPMPD_CORNER_SMPA(_platform, _name, _active, r_id) \
31 static struct rpmpd _platform##_##_active; \
32 static struct rpmpd _platform##_##_name = { \
33 .pd = { .name = #_name, }, \
34 .peer = &_platform##_##_active, \
35 .res_type = RPMPD_SMPA, \
39 static struct rpmpd _platform##_##_active = { \
40 .pd = { .name = #_active, }, \
41 .peer = &_platform##_##_name, \
42 .active_only = true, \
43 .res_type = RPMPD_SMPA, \
48 #define DEFINE_RPMPD_CORNER_LDOA(_platform, _name, r_id) \
49 static struct rpmpd _platform##_##_name = { \
50 .pd = { .name = #_name, }, \
51 .res_type = RPMPD_LDOA, \
56 #define DEFINE_RPMPD_VFC(_platform, _name, r_id, r_type) \
57 static struct rpmpd _platform##_##_name = { \
58 .pd = { .name = #_name, }, \
61 .key = KEY_FLOOR_CORNER, \
64 #define DEFINE_RPMPD_VFC_SMPA(_platform, _name, r_id) \
65 DEFINE_RPMPD_VFC(_platform, _name, r_id, RPMPD_SMPA)
67 #define DEFINE_RPMPD_VFC_LDOA(_platform, _name, r_id) \
68 DEFINE_RPMPD_VFC(_platform, _name, r_id, RPMPD_LDOA)
77 struct generic_pm_domain pd;
79 const bool active_only;
85 struct qcom_smd_rpm *rpm;
90 struct rpmpd **rpmpds;
94 static DEFINE_MUTEX(rpmpd_lock);
96 /* msm8996 RPM Power domains */
97 DEFINE_RPMPD_CORNER_SMPA(msm8996, vddcx, vddcx_ao, 1);
98 DEFINE_RPMPD_CORNER_SMPA(msm8996, vddmx, vddmx_ao, 2);
99 DEFINE_RPMPD_CORNER_LDOA(msm8996, vddsscx, 26);
101 DEFINE_RPMPD_VFC_SMPA(msm8996, vddcx_vfc, 1);
102 DEFINE_RPMPD_VFC_LDOA(msm8996, vddsscx_vfc, 26);
104 static struct rpmpd *msm8996_rpmpds[] = {
105 [MSM8996_VDDCX] = &msm8996_vddcx,
106 [MSM8996_VDDCX_AO] = &msm8996_vddcx_ao,
107 [MSM8996_VDDCX_VFC] = &msm8996_vddcx_vfc,
108 [MSM8996_VDDMX] = &msm8996_vddmx,
109 [MSM8996_VDDMX_AO] = &msm8996_vddmx_ao,
110 [MSM8996_VDDSSCX] = &msm8996_vddsscx,
111 [MSM8996_VDDSSCX_VFC] = &msm8996_vddsscx_vfc,
114 static const struct rpmpd_desc msm8996_desc = {
115 .rpmpds = msm8996_rpmpds,
116 .num_pds = ARRAY_SIZE(msm8996_rpmpds),
119 static const struct of_device_id rpmpd_match_table[] = {
120 { .compatible = "qcom,msm8996-rpmpd", .data = &msm8996_desc },
124 static int rpmpd_send_enable(struct rpmpd *pd, bool enable)
126 struct rpmpd_req req = {
128 .nbytes = cpu_to_le32(sizeof(u32)),
129 .value = cpu_to_le32(enable),
132 return qcom_rpm_smd_write(pd->rpm, QCOM_SMD_RPM_ACTIVE_STATE,
133 pd->res_type, pd->res_id, &req, sizeof(req));
136 static int rpmpd_send_corner(struct rpmpd *pd, int state, unsigned int corner)
138 struct rpmpd_req req = {
140 .nbytes = cpu_to_le32(sizeof(u32)),
141 .value = cpu_to_le32(corner),
144 return qcom_rpm_smd_write(pd->rpm, state, pd->res_type, pd->res_id,
148 static void to_active_sleep(struct rpmpd *pd, unsigned int corner,
149 unsigned int *active, unsigned int *sleep)
159 static int rpmpd_aggregate_corner(struct rpmpd *pd)
162 struct rpmpd *peer = pd->peer;
163 unsigned int active_corner, sleep_corner;
164 unsigned int this_active_corner = 0, this_sleep_corner = 0;
165 unsigned int peer_active_corner = 0, peer_sleep_corner = 0;
167 to_active_sleep(pd, pd->corner, &this_active_corner, &this_sleep_corner);
169 if (peer && peer->enabled)
170 to_active_sleep(peer, peer->corner, &peer_active_corner,
173 active_corner = max(this_active_corner, peer_active_corner);
175 ret = rpmpd_send_corner(pd, QCOM_SMD_RPM_ACTIVE_STATE, active_corner);
179 sleep_corner = max(this_sleep_corner, peer_sleep_corner);
181 return rpmpd_send_corner(pd, QCOM_SMD_RPM_SLEEP_STATE, sleep_corner);
184 static int rpmpd_power_on(struct generic_pm_domain *domain)
187 struct rpmpd *pd = domain_to_rpmpd(domain);
189 mutex_lock(&rpmpd_lock);
191 ret = rpmpd_send_enable(pd, true);
198 ret = rpmpd_aggregate_corner(pd);
201 mutex_unlock(&rpmpd_lock);
206 static int rpmpd_power_off(struct generic_pm_domain *domain)
209 struct rpmpd *pd = domain_to_rpmpd(domain);
211 mutex_lock(&rpmpd_lock);
213 ret = rpmpd_send_enable(pd, false);
217 mutex_unlock(&rpmpd_lock);
222 static int rpmpd_set_performance(struct generic_pm_domain *domain,
226 struct rpmpd *pd = domain_to_rpmpd(domain);
228 if (state > MAX_RPMPD_STATE)
231 mutex_lock(&rpmpd_lock);
235 if (!pd->enabled && pd->key != KEY_FLOOR_CORNER)
238 ret = rpmpd_aggregate_corner(pd);
241 mutex_unlock(&rpmpd_lock);
246 static unsigned int rpmpd_get_performance(struct generic_pm_domain *genpd,
247 struct dev_pm_opp *opp)
249 return dev_pm_opp_get_level(opp);
252 static int rpmpd_probe(struct platform_device *pdev)
256 struct genpd_onecell_data *data;
257 struct qcom_smd_rpm *rpm;
258 struct rpmpd **rpmpds;
259 const struct rpmpd_desc *desc;
261 rpm = dev_get_drvdata(pdev->dev.parent);
263 dev_err(&pdev->dev, "Unable to retrieve handle to RPM\n");
267 desc = of_device_get_match_data(&pdev->dev);
271 rpmpds = desc->rpmpds;
274 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
278 data->domains = devm_kcalloc(&pdev->dev, num, sizeof(*data->domains),
280 data->num_domains = num;
282 for (i = 0; i < num; i++) {
284 dev_warn(&pdev->dev, "rpmpds[] with empty entry at index=%d\n",
289 rpmpds[i]->rpm = rpm;
290 rpmpds[i]->pd.power_off = rpmpd_power_off;
291 rpmpds[i]->pd.power_on = rpmpd_power_on;
292 rpmpds[i]->pd.set_performance_state = rpmpd_set_performance;
293 rpmpds[i]->pd.opp_to_performance_state = rpmpd_get_performance;
294 pm_genpd_init(&rpmpds[i]->pd, NULL, true);
296 data->domains[i] = &rpmpds[i]->pd;
299 return of_genpd_add_provider_onecell(pdev->dev.of_node, data);
302 static struct platform_driver rpmpd_driver = {
304 .name = "qcom-rpmpd",
305 .of_match_table = rpmpd_match_table,
306 .suppress_bind_attrs = true,
308 .probe = rpmpd_probe,
311 static int __init rpmpd_init(void)
313 return platform_driver_register(&rpmpd_driver);
315 core_initcall(rpmpd_init);