1 // SPDX-License-Identifier: GPL-2.0
15 #include <soc/qcom/cmd-db.h>
17 #include <dt-bindings/power/qcom-rpmpd.h>
24  * struct rpmhpd - top level RPMh power domain resource data structure
33  * @enable_corner:	lowest non-zero corner
35  *			derived from cmd-db
37  *			being 16 (0 - 15)
39  * @res_name:		Resource name used for cmd-db lookup
41  *			cmd-db
89 	.pd = { .name = "mss", },
90 	.res_name = "mss.lvl",
193 /* SC7180 RPMH powerdomains */
211 	{ .compatible = "qcom,sc7180-rpmhpd", .data = &sc7180_desc },
212 	{ .compatible = "qcom,sdm845-rpmhpd", .data = &sdm845_desc },
213 	{ .compatible = "qcom,sm8150-rpmhpd", .data = &sm8150_desc },
214 	{ .compatible = "qcom,sm8250-rpmhpd", .data = &sm8250_desc },
223 		.addr = pd->addr,  in rpmhpd_send_corner()
232 		return rpmh_write(pd->dev, state, &cmd, 1);  in rpmhpd_send_corner()
234 		return rpmh_write_async(pd->dev, state, &cmd, 1);  in rpmhpd_send_corner()
242 	if (pd->active_only)  in to_active_sleep()
260 	struct rpmhpd *peer = pd->peer;  in rpmhpd_aggregate_corner()
267 	if (peer && peer->enabled)  in rpmhpd_aggregate_corner()
268 		to_active_sleep(peer, peer->corner, &peer_active_corner,  in rpmhpd_aggregate_corner()
274 				 active_corner > pd->active_corner);  in rpmhpd_aggregate_corner()
278 	pd->active_corner = active_corner;  in rpmhpd_aggregate_corner()
281 		peer->active_corner = active_corner;  in rpmhpd_aggregate_corner()
305 	corner = max(pd->corner, pd->enable_corner);  in rpmhpd_power_on()
308 		pd->enabled = true;  in rpmhpd_power_on()
324 		pd->enabled = false;  in rpmhpd_power_off()
339 	for (i = 0; i < pd->level_count; i++)  in rpmhpd_set_performance_state()
340 		if (level <= pd->level[i])  in rpmhpd_set_performance_state()
347 	if (i == pd->level_count)  in rpmhpd_set_performance_state()
348 		i--;  in rpmhpd_set_performance_state()
350 	if (pd->enabled) {  in rpmhpd_set_performance_state()
352 		if (i < pd->enable_corner)  in rpmhpd_set_performance_state()
353 			i = pd->enable_corner;  in rpmhpd_set_performance_state()
360 	pd->corner = i;  in rpmhpd_set_performance_state()
378 	buf = cmd_db_read_aux_data(rpmhpd->res_name, &rpmhpd->level_count);  in rpmhpd_update_level_mapping()
383 	rpmhpd->level_count >>= 1;  in rpmhpd_update_level_mapping()
385 	if (rpmhpd->level_count > RPMH_ARC_MAX_LEVELS)  in rpmhpd_update_level_mapping()
386 		return -EINVAL;  in rpmhpd_update_level_mapping()
388 	for (i = 0; i < rpmhpd->level_count; i++) {  in rpmhpd_update_level_mapping()
389 		rpmhpd->level[i] = buf[i];  in rpmhpd_update_level_mapping()
391 		/* Remember the first corner with non-zero level */  in rpmhpd_update_level_mapping()
392 		if (!rpmhpd->level[rpmhpd->enable_corner] && rpmhpd->level[i])  in rpmhpd_update_level_mapping()
393 			rpmhpd->enable_corner = i;  in rpmhpd_update_level_mapping()
399 		if (i > 0 && rpmhpd->level[i] == 0) {  in rpmhpd_update_level_mapping()
400 			rpmhpd->level_count = i;  in rpmhpd_update_level_mapping()
403 		pr_debug("%s: ARC hlvl=%2d --> vlvl=%4u\n", rpmhpd->res_name, i,  in rpmhpd_update_level_mapping()
404 			 rpmhpd->level[i]);  in rpmhpd_update_level_mapping()
414 	struct device *dev = &pdev->dev;  in rpmhpd_probe()
421 		return -EINVAL;  in rpmhpd_probe()
423 	rpmhpds = desc->rpmhpds;  in rpmhpd_probe()
424 	num_pds = desc->num_pds;  in rpmhpd_probe()
428 		return -ENOMEM;  in rpmhpd_probe()
430 	data->domains = devm_kcalloc(dev, num_pds, sizeof(*data->domains),  in rpmhpd_probe()
432 	if (!data->domains)  in rpmhpd_probe()
433 		return -ENOMEM;  in rpmhpd_probe()
435 	data->num_domains = num_pds;  in rpmhpd_probe()
443 		rpmhpds[i]->dev = dev;  in rpmhpd_probe()
444 		rpmhpds[i]->addr = cmd_db_read_addr(rpmhpds[i]->res_name);  in rpmhpd_probe()
445 		if (!rpmhpds[i]->addr) {  in rpmhpd_probe()
447 				rpmhpds[i]->res_name);  in rpmhpd_probe()
448 			return -ENODEV;  in rpmhpd_probe()
451 		ret = cmd_db_read_slave_id(rpmhpds[i]->res_name);  in rpmhpd_probe()
454 			return -EINVAL;  in rpmhpd_probe()
461 		rpmhpds[i]->pd.power_off = rpmhpd_power_off;  in rpmhpd_probe()
462 		rpmhpds[i]->pd.power_on = rpmhpd_power_on;  in rpmhpd_probe()
463 		rpmhpds[i]->pd.set_performance_state = rpmhpd_set_performance_state;  in rpmhpd_probe()
464 		rpmhpds[i]->pd.opp_to_performance_state = rpmhpd_get_performance_state;  in rpmhpd_probe()
465 		pm_genpd_init(&rpmhpds[i]->pd, NULL, true);  in rpmhpd_probe()
467 		data->domains[i] = &rpmhpds[i]->pd;  in rpmhpd_probe()
474 		if (rpmhpds[i]->parent)  in rpmhpd_probe()
475 			pm_genpd_add_subdomain(rpmhpds[i]->parent,  in rpmhpd_probe()
476 					       &rpmhpds[i]->pd);  in rpmhpd_probe()
479 	return of_genpd_add_provider_onecell(pdev->dev.of_node, data);  in rpmhpd_probe()
484 		.name = "qcom-rpmhpd",