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/module.h>
8 #include <linux/mutex.h>
9 #include <linux/pm_domain.h>
11 #include <linux/of_device.h>
12 #include <linux/platform_device.h>
13 #include <linux/pm_opp.h>
14 #include <linux/soc/qcom/smd-rpm.h>
16 #include <dt-bindings/power/qcom-rpmpd.h>
18 #define domain_to_rpmpd(domain) container_of(domain, struct rpmpd, pd)
21 * RPMPD_X is X encoded as a little-endian, lower-case, ASCII string */
22 #define RPMPD_SMPA 0x61706d73
23 #define RPMPD_LDOA 0x616f646c
24 #define RPMPD_SMPB 0x62706d73
25 #define RPMPD_LDOB 0x626f646c
26 #define RPMPD_RWCX 0x78637772
27 #define RPMPD_RWMX 0x786d7772
28 #define RPMPD_RWLC 0x636c7772
29 #define RPMPD_RWLM 0x6d6c7772
30 #define RPMPD_RWSC 0x63737772
31 #define RPMPD_RWSM 0x6d737772
34 #define KEY_CORNER 0x6e726f63 /* corn */
35 #define KEY_ENABLE 0x6e657773 /* swen */
36 #define KEY_FLOOR_CORNER 0x636676 /* vfc */
37 #define KEY_FLOOR_LEVEL 0x6c6676 /* vfl */
38 #define KEY_LEVEL 0x6c766c76 /* vlvl */
40 #define MAX_CORNER_RPMPD_STATE 6
42 #define DEFINE_RPMPD_PAIR(_platform, _name, _active, r_type, r_key, \
44 static struct rpmpd _platform##_##_active; \
45 static struct rpmpd _platform##_##_name = { \
46 .pd = { .name = #_name, }, \
47 .peer = &_platform##_##_active, \
48 .res_type = RPMPD_##r_type, \
52 static struct rpmpd _platform##_##_active = { \
53 .pd = { .name = #_active, }, \
54 .peer = &_platform##_##_name, \
55 .active_only = true, \
56 .res_type = RPMPD_##r_type, \
61 #define DEFINE_RPMPD_CORNER(_platform, _name, r_type, r_id) \
62 static struct rpmpd _platform##_##_name = { \
63 .pd = { .name = #_name, }, \
64 .res_type = RPMPD_##r_type, \
69 #define DEFINE_RPMPD_LEVEL(_platform, _name, r_type, r_id) \
70 static struct rpmpd _platform##_##_name = { \
71 .pd = { .name = #_name, }, \
72 .res_type = RPMPD_##r_type, \
77 #define DEFINE_RPMPD_VFC(_platform, _name, r_type, r_id) \
78 static struct rpmpd _platform##_##_name = { \
79 .pd = { .name = #_name, }, \
80 .res_type = RPMPD_##r_type, \
82 .key = KEY_FLOOR_CORNER, \
85 #define DEFINE_RPMPD_VFL(_platform, _name, r_type, r_id) \
86 static struct rpmpd _platform##_##_name = { \
87 .pd = { .name = #_name, }, \
88 .res_type = RPMPD_##r_type, \
90 .key = KEY_FLOOR_LEVEL, \
100 struct generic_pm_domain pd
;
102 const bool active_only
;
105 const char *res_name
;
108 struct qcom_smd_rpm
*rpm
;
109 unsigned int max_state
;
114 struct rpmpd
**rpmpds
;
116 unsigned int max_state
;
119 static DEFINE_MUTEX(rpmpd_lock
);
121 /* msm8939 RPM Power Domains */
122 DEFINE_RPMPD_PAIR(msm8939
, vddmd
, vddmd_ao
, SMPA
, CORNER
, 1);
123 DEFINE_RPMPD_VFC(msm8939
, vddmd_vfc
, SMPA
, 1);
125 DEFINE_RPMPD_PAIR(msm8939
, vddcx
, vddcx_ao
, SMPA
, CORNER
, 2);
126 DEFINE_RPMPD_VFC(msm8939
, vddcx_vfc
, SMPA
, 2);
128 DEFINE_RPMPD_PAIR(msm8939
, vddmx
, vddmx_ao
, LDOA
, CORNER
, 3);
130 static struct rpmpd
*msm8939_rpmpds
[] = {
131 [MSM8939_VDDMDCX
] = &msm8939_vddmd
,
132 [MSM8939_VDDMDCX_AO
] = &msm8939_vddmd_ao
,
133 [MSM8939_VDDMDCX_VFC
] = &msm8939_vddmd_vfc
,
134 [MSM8939_VDDCX
] = &msm8939_vddcx
,
135 [MSM8939_VDDCX_AO
] = &msm8939_vddcx_ao
,
136 [MSM8939_VDDCX_VFC
] = &msm8939_vddcx_vfc
,
137 [MSM8939_VDDMX
] = &msm8939_vddmx
,
138 [MSM8939_VDDMX_AO
] = &msm8939_vddmx_ao
,
141 static const struct rpmpd_desc msm8939_desc
= {
142 .rpmpds
= msm8939_rpmpds
,
143 .num_pds
= ARRAY_SIZE(msm8939_rpmpds
),
144 .max_state
= MAX_CORNER_RPMPD_STATE
,
147 /* msm8916 RPM Power Domains */
148 DEFINE_RPMPD_PAIR(msm8916
, vddcx
, vddcx_ao
, SMPA
, CORNER
, 1);
149 DEFINE_RPMPD_PAIR(msm8916
, vddmx
, vddmx_ao
, LDOA
, CORNER
, 3);
151 DEFINE_RPMPD_VFC(msm8916
, vddcx_vfc
, SMPA
, 1);
153 static struct rpmpd
*msm8916_rpmpds
[] = {
154 [MSM8916_VDDCX
] = &msm8916_vddcx
,
155 [MSM8916_VDDCX_AO
] = &msm8916_vddcx_ao
,
156 [MSM8916_VDDCX_VFC
] = &msm8916_vddcx_vfc
,
157 [MSM8916_VDDMX
] = &msm8916_vddmx
,
158 [MSM8916_VDDMX_AO
] = &msm8916_vddmx_ao
,
161 static const struct rpmpd_desc msm8916_desc
= {
162 .rpmpds
= msm8916_rpmpds
,
163 .num_pds
= ARRAY_SIZE(msm8916_rpmpds
),
164 .max_state
= MAX_CORNER_RPMPD_STATE
,
167 /* msm8976 RPM Power Domains */
168 DEFINE_RPMPD_PAIR(msm8976
, vddcx
, vddcx_ao
, SMPA
, LEVEL
, 2);
169 DEFINE_RPMPD_PAIR(msm8976
, vddmx
, vddmx_ao
, SMPA
, LEVEL
, 6);
171 DEFINE_RPMPD_VFL(msm8976
, vddcx_vfl
, RWSC
, 2);
172 DEFINE_RPMPD_VFL(msm8976
, vddmx_vfl
, RWSM
, 6);
174 static struct rpmpd
*msm8976_rpmpds
[] = {
175 [MSM8976_VDDCX
] = &msm8976_vddcx
,
176 [MSM8976_VDDCX_AO
] = &msm8976_vddcx_ao
,
177 [MSM8976_VDDCX_VFL
] = &msm8976_vddcx_vfl
,
178 [MSM8976_VDDMX
] = &msm8976_vddmx
,
179 [MSM8976_VDDMX_AO
] = &msm8976_vddmx_ao
,
180 [MSM8976_VDDMX_VFL
] = &msm8976_vddmx_vfl
,
183 static const struct rpmpd_desc msm8976_desc
= {
184 .rpmpds
= msm8976_rpmpds
,
185 .num_pds
= ARRAY_SIZE(msm8976_rpmpds
),
186 .max_state
= RPM_SMD_LEVEL_TURBO_HIGH
,
189 /* msm8994 RPM Power domains */
190 DEFINE_RPMPD_PAIR(msm8994
, vddcx
, vddcx_ao
, SMPA
, CORNER
, 1);
191 DEFINE_RPMPD_PAIR(msm8994
, vddmx
, vddmx_ao
, SMPA
, CORNER
, 2);
192 /* Attention! *Some* 8994 boards with pm8004 may use SMPC here! */
193 DEFINE_RPMPD_CORNER(msm8994
, vddgfx
, SMPB
, 2);
195 DEFINE_RPMPD_VFC(msm8994
, vddcx_vfc
, SMPA
, 1);
196 DEFINE_RPMPD_VFC(msm8994
, vddgfx_vfc
, SMPB
, 2);
198 static struct rpmpd
*msm8994_rpmpds
[] = {
199 [MSM8994_VDDCX
] = &msm8994_vddcx
,
200 [MSM8994_VDDCX_AO
] = &msm8994_vddcx_ao
,
201 [MSM8994_VDDCX_VFC
] = &msm8994_vddcx_vfc
,
202 [MSM8994_VDDMX
] = &msm8994_vddmx
,
203 [MSM8994_VDDMX_AO
] = &msm8994_vddmx_ao
,
204 [MSM8994_VDDGFX
] = &msm8994_vddgfx
,
205 [MSM8994_VDDGFX_VFC
] = &msm8994_vddgfx_vfc
,
208 static const struct rpmpd_desc msm8994_desc
= {
209 .rpmpds
= msm8994_rpmpds
,
210 .num_pds
= ARRAY_SIZE(msm8994_rpmpds
),
211 .max_state
= MAX_CORNER_RPMPD_STATE
,
214 /* msm8996 RPM Power domains */
215 DEFINE_RPMPD_PAIR(msm8996
, vddcx
, vddcx_ao
, SMPA
, CORNER
, 1);
216 DEFINE_RPMPD_PAIR(msm8996
, vddmx
, vddmx_ao
, SMPA
, CORNER
, 2);
217 DEFINE_RPMPD_CORNER(msm8996
, vddsscx
, LDOA
, 26);
219 DEFINE_RPMPD_VFC(msm8996
, vddcx_vfc
, SMPA
, 1);
220 DEFINE_RPMPD_VFC(msm8996
, vddsscx_vfc
, LDOA
, 26);
222 static struct rpmpd
*msm8996_rpmpds
[] = {
223 [MSM8996_VDDCX
] = &msm8996_vddcx
,
224 [MSM8996_VDDCX_AO
] = &msm8996_vddcx_ao
,
225 [MSM8996_VDDCX_VFC
] = &msm8996_vddcx_vfc
,
226 [MSM8996_VDDMX
] = &msm8996_vddmx
,
227 [MSM8996_VDDMX_AO
] = &msm8996_vddmx_ao
,
228 [MSM8996_VDDSSCX
] = &msm8996_vddsscx
,
229 [MSM8996_VDDSSCX_VFC
] = &msm8996_vddsscx_vfc
,
232 static const struct rpmpd_desc msm8996_desc
= {
233 .rpmpds
= msm8996_rpmpds
,
234 .num_pds
= ARRAY_SIZE(msm8996_rpmpds
),
235 .max_state
= MAX_CORNER_RPMPD_STATE
,
238 /* msm8998 RPM Power domains */
239 DEFINE_RPMPD_PAIR(msm8998
, vddcx
, vddcx_ao
, RWCX
, LEVEL
, 0);
240 DEFINE_RPMPD_VFL(msm8998
, vddcx_vfl
, RWCX
, 0);
242 DEFINE_RPMPD_PAIR(msm8998
, vddmx
, vddmx_ao
, RWMX
, LEVEL
, 0);
243 DEFINE_RPMPD_VFL(msm8998
, vddmx_vfl
, RWMX
, 0);
245 DEFINE_RPMPD_LEVEL(msm8998
, vdd_ssccx
, RWSC
, 0);
246 DEFINE_RPMPD_VFL(msm8998
, vdd_ssccx_vfl
, RWSC
, 0);
248 DEFINE_RPMPD_LEVEL(msm8998
, vdd_sscmx
, RWSM
, 0);
249 DEFINE_RPMPD_VFL(msm8998
, vdd_sscmx_vfl
, RWSM
, 0);
251 static struct rpmpd
*msm8998_rpmpds
[] = {
252 [MSM8998_VDDCX
] = &msm8998_vddcx
,
253 [MSM8998_VDDCX_AO
] = &msm8998_vddcx_ao
,
254 [MSM8998_VDDCX_VFL
] = &msm8998_vddcx_vfl
,
255 [MSM8998_VDDMX
] = &msm8998_vddmx
,
256 [MSM8998_VDDMX_AO
] = &msm8998_vddmx_ao
,
257 [MSM8998_VDDMX_VFL
] = &msm8998_vddmx_vfl
,
258 [MSM8998_SSCCX
] = &msm8998_vdd_ssccx
,
259 [MSM8998_SSCCX_VFL
] = &msm8998_vdd_ssccx_vfl
,
260 [MSM8998_SSCMX
] = &msm8998_vdd_sscmx
,
261 [MSM8998_SSCMX_VFL
] = &msm8998_vdd_sscmx_vfl
,
264 static const struct rpmpd_desc msm8998_desc
= {
265 .rpmpds
= msm8998_rpmpds
,
266 .num_pds
= ARRAY_SIZE(msm8998_rpmpds
),
267 .max_state
= RPM_SMD_LEVEL_BINNING
,
270 /* qcs404 RPM Power domains */
271 DEFINE_RPMPD_PAIR(qcs404
, vddmx
, vddmx_ao
, RWMX
, LEVEL
, 0);
272 DEFINE_RPMPD_VFL(qcs404
, vddmx_vfl
, RWMX
, 0);
274 DEFINE_RPMPD_LEVEL(qcs404
, vdd_lpicx
, RWLC
, 0);
275 DEFINE_RPMPD_VFL(qcs404
, vdd_lpicx_vfl
, RWLC
, 0);
277 DEFINE_RPMPD_LEVEL(qcs404
, vdd_lpimx
, RWLM
, 0);
278 DEFINE_RPMPD_VFL(qcs404
, vdd_lpimx_vfl
, RWLM
, 0);
280 static struct rpmpd
*qcs404_rpmpds
[] = {
281 [QCS404_VDDMX
] = &qcs404_vddmx
,
282 [QCS404_VDDMX_AO
] = &qcs404_vddmx_ao
,
283 [QCS404_VDDMX_VFL
] = &qcs404_vddmx_vfl
,
284 [QCS404_LPICX
] = &qcs404_vdd_lpicx
,
285 [QCS404_LPICX_VFL
] = &qcs404_vdd_lpicx_vfl
,
286 [QCS404_LPIMX
] = &qcs404_vdd_lpimx
,
287 [QCS404_LPIMX_VFL
] = &qcs404_vdd_lpimx_vfl
,
290 static const struct rpmpd_desc qcs404_desc
= {
291 .rpmpds
= qcs404_rpmpds
,
292 .num_pds
= ARRAY_SIZE(qcs404_rpmpds
),
293 .max_state
= RPM_SMD_LEVEL_BINNING
,
296 /* sdm660 RPM Power domains */
297 DEFINE_RPMPD_PAIR(sdm660
, vddcx
, vddcx_ao
, RWCX
, LEVEL
, 0);
298 DEFINE_RPMPD_VFL(sdm660
, vddcx_vfl
, RWCX
, 0);
300 DEFINE_RPMPD_PAIR(sdm660
, vddmx
, vddmx_ao
, RWMX
, LEVEL
, 0);
301 DEFINE_RPMPD_VFL(sdm660
, vddmx_vfl
, RWMX
, 0);
303 DEFINE_RPMPD_LEVEL(sdm660
, vdd_ssccx
, RWLC
, 0);
304 DEFINE_RPMPD_VFL(sdm660
, vdd_ssccx_vfl
, RWLC
, 0);
306 DEFINE_RPMPD_LEVEL(sdm660
, vdd_sscmx
, RWLM
, 0);
307 DEFINE_RPMPD_VFL(sdm660
, vdd_sscmx_vfl
, RWLM
, 0);
309 static struct rpmpd
*sdm660_rpmpds
[] = {
310 [SDM660_VDDCX
] = &sdm660_vddcx
,
311 [SDM660_VDDCX_AO
] = &sdm660_vddcx_ao
,
312 [SDM660_VDDCX_VFL
] = &sdm660_vddcx_vfl
,
313 [SDM660_VDDMX
] = &sdm660_vddmx
,
314 [SDM660_VDDMX_AO
] = &sdm660_vddmx_ao
,
315 [SDM660_VDDMX_VFL
] = &sdm660_vddmx_vfl
,
316 [SDM660_SSCCX
] = &sdm660_vdd_ssccx
,
317 [SDM660_SSCCX_VFL
] = &sdm660_vdd_ssccx_vfl
,
318 [SDM660_SSCMX
] = &sdm660_vdd_sscmx
,
319 [SDM660_SSCMX_VFL
] = &sdm660_vdd_sscmx_vfl
,
322 static const struct rpmpd_desc sdm660_desc
= {
323 .rpmpds
= sdm660_rpmpds
,
324 .num_pds
= ARRAY_SIZE(sdm660_rpmpds
),
325 .max_state
= RPM_SMD_LEVEL_TURBO
,
328 static const struct of_device_id rpmpd_match_table
[] = {
329 { .compatible
= "qcom,msm8916-rpmpd", .data
= &msm8916_desc
},
330 { .compatible
= "qcom,msm8939-rpmpd", .data
= &msm8939_desc
},
331 { .compatible
= "qcom,msm8976-rpmpd", .data
= &msm8976_desc
},
332 { .compatible
= "qcom,msm8994-rpmpd", .data
= &msm8994_desc
},
333 { .compatible
= "qcom,msm8996-rpmpd", .data
= &msm8996_desc
},
334 { .compatible
= "qcom,msm8998-rpmpd", .data
= &msm8998_desc
},
335 { .compatible
= "qcom,qcs404-rpmpd", .data
= &qcs404_desc
},
336 { .compatible
= "qcom,sdm660-rpmpd", .data
= &sdm660_desc
},
339 MODULE_DEVICE_TABLE(of
, rpmpd_match_table
);
341 static int rpmpd_send_enable(struct rpmpd
*pd
, bool enable
)
343 struct rpmpd_req req
= {
345 .nbytes
= cpu_to_le32(sizeof(u32
)),
346 .value
= cpu_to_le32(enable
),
349 return qcom_rpm_smd_write(pd
->rpm
, QCOM_SMD_RPM_ACTIVE_STATE
,
350 pd
->res_type
, pd
->res_id
, &req
, sizeof(req
));
353 static int rpmpd_send_corner(struct rpmpd
*pd
, int state
, unsigned int corner
)
355 struct rpmpd_req req
= {
357 .nbytes
= cpu_to_le32(sizeof(u32
)),
358 .value
= cpu_to_le32(corner
),
361 return qcom_rpm_smd_write(pd
->rpm
, state
, pd
->res_type
, pd
->res_id
,
365 static void to_active_sleep(struct rpmpd
*pd
, unsigned int corner
,
366 unsigned int *active
, unsigned int *sleep
)
376 static int rpmpd_aggregate_corner(struct rpmpd
*pd
)
379 struct rpmpd
*peer
= pd
->peer
;
380 unsigned int active_corner
, sleep_corner
;
381 unsigned int this_active_corner
= 0, this_sleep_corner
= 0;
382 unsigned int peer_active_corner
= 0, peer_sleep_corner
= 0;
384 to_active_sleep(pd
, pd
->corner
, &this_active_corner
, &this_sleep_corner
);
386 if (peer
&& peer
->enabled
)
387 to_active_sleep(peer
, peer
->corner
, &peer_active_corner
,
390 active_corner
= max(this_active_corner
, peer_active_corner
);
392 ret
= rpmpd_send_corner(pd
, QCOM_SMD_RPM_ACTIVE_STATE
, active_corner
);
396 sleep_corner
= max(this_sleep_corner
, peer_sleep_corner
);
398 return rpmpd_send_corner(pd
, QCOM_SMD_RPM_SLEEP_STATE
, sleep_corner
);
401 static int rpmpd_power_on(struct generic_pm_domain
*domain
)
404 struct rpmpd
*pd
= domain_to_rpmpd(domain
);
406 mutex_lock(&rpmpd_lock
);
408 ret
= rpmpd_send_enable(pd
, true);
415 ret
= rpmpd_aggregate_corner(pd
);
418 mutex_unlock(&rpmpd_lock
);
423 static int rpmpd_power_off(struct generic_pm_domain
*domain
)
426 struct rpmpd
*pd
= domain_to_rpmpd(domain
);
428 mutex_lock(&rpmpd_lock
);
430 ret
= rpmpd_send_enable(pd
, false);
434 mutex_unlock(&rpmpd_lock
);
439 static int rpmpd_set_performance(struct generic_pm_domain
*domain
,
443 struct rpmpd
*pd
= domain_to_rpmpd(domain
);
445 if (state
> pd
->max_state
)
446 state
= pd
->max_state
;
448 mutex_lock(&rpmpd_lock
);
452 /* Always send updates for vfc and vfl */
453 if (!pd
->enabled
&& pd
->key
!= KEY_FLOOR_CORNER
&&
454 pd
->key
!= KEY_FLOOR_LEVEL
)
457 ret
= rpmpd_aggregate_corner(pd
);
460 mutex_unlock(&rpmpd_lock
);
465 static unsigned int rpmpd_get_performance(struct generic_pm_domain
*genpd
,
466 struct dev_pm_opp
*opp
)
468 return dev_pm_opp_get_level(opp
);
471 static int rpmpd_probe(struct platform_device
*pdev
)
475 struct genpd_onecell_data
*data
;
476 struct qcom_smd_rpm
*rpm
;
477 struct rpmpd
**rpmpds
;
478 const struct rpmpd_desc
*desc
;
480 rpm
= dev_get_drvdata(pdev
->dev
.parent
);
482 dev_err(&pdev
->dev
, "Unable to retrieve handle to RPM\n");
486 desc
= of_device_get_match_data(&pdev
->dev
);
490 rpmpds
= desc
->rpmpds
;
493 data
= devm_kzalloc(&pdev
->dev
, sizeof(*data
), GFP_KERNEL
);
497 data
->domains
= devm_kcalloc(&pdev
->dev
, num
, sizeof(*data
->domains
),
499 data
->num_domains
= num
;
501 for (i
= 0; i
< num
; i
++) {
503 dev_warn(&pdev
->dev
, "rpmpds[] with empty entry at index=%d\n",
508 rpmpds
[i
]->rpm
= rpm
;
509 rpmpds
[i
]->max_state
= desc
->max_state
;
510 rpmpds
[i
]->pd
.power_off
= rpmpd_power_off
;
511 rpmpds
[i
]->pd
.power_on
= rpmpd_power_on
;
512 rpmpds
[i
]->pd
.set_performance_state
= rpmpd_set_performance
;
513 rpmpds
[i
]->pd
.opp_to_performance_state
= rpmpd_get_performance
;
514 pm_genpd_init(&rpmpds
[i
]->pd
, NULL
, true);
516 data
->domains
[i
] = &rpmpds
[i
]->pd
;
519 return of_genpd_add_provider_onecell(pdev
->dev
.of_node
, data
);
522 static struct platform_driver rpmpd_driver
= {
524 .name
= "qcom-rpmpd",
525 .of_match_table
= rpmpd_match_table
,
526 .suppress_bind_attrs
= true,
528 .probe
= rpmpd_probe
,
531 static int __init
rpmpd_init(void)
533 return platform_driver_register(&rpmpd_driver
);
535 core_initcall(rpmpd_init
);
537 MODULE_DESCRIPTION("Qualcomm Technologies, Inc. RPM Power Domain Driver");
538 MODULE_LICENSE("GPL v2");