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
31  *			derived from cmd-db
33  *			being 16 (0 - 15)
35  * @res_name:		Resource name used for cmd-db lookup
37  *			cmd-db
84 	.pd = { .name = "mss", },
85 	.res_name = "mss.lvl",
188 /* SC7180 RPMH powerdomains */
206 	{ .compatible = "qcom,sc7180-rpmhpd", .data = &sc7180_desc },
207 	{ .compatible = "qcom,sdm845-rpmhpd", .data = &sdm845_desc },
208 	{ .compatible = "qcom,sm8150-rpmhpd", .data = &sm8150_desc },
209 	{ .compatible = "qcom,sm8250-rpmhpd", .data = &sm8250_desc },
218 		.addr = pd->addr,  in rpmhpd_send_corner()
227 		return rpmh_write(pd->dev, state, &cmd, 1);  in rpmhpd_send_corner()
229 		return rpmh_write_async(pd->dev, state, &cmd, 1);  in rpmhpd_send_corner()
237 	if (pd->active_only)  in to_active_sleep()
255 	struct rpmhpd *peer = pd->peer;  in rpmhpd_aggregate_corner()
262 	if (peer && peer->enabled)  in rpmhpd_aggregate_corner()
263 		to_active_sleep(peer, peer->corner, &peer_active_corner,  in rpmhpd_aggregate_corner()
269 				 active_corner > pd->active_corner);  in rpmhpd_aggregate_corner()
273 	pd->active_corner = active_corner;  in rpmhpd_aggregate_corner()
276 		peer->active_corner = active_corner;  in rpmhpd_aggregate_corner()
299 	if (pd->corner)  in rpmhpd_power_on()
300 		ret = rpmhpd_aggregate_corner(pd, pd->corner);  in rpmhpd_power_on()
303 		pd->enabled = true;  in rpmhpd_power_on()
317 	ret = rpmhpd_aggregate_corner(pd, pd->level[0]);  in rpmhpd_power_off()
320 		pd->enabled = false;  in rpmhpd_power_off()
335 	for (i = 0; i < pd->level_count; i++)  in rpmhpd_set_performance_state()
336 		if (level <= pd->level[i])  in rpmhpd_set_performance_state()
343 	if (i == pd->level_count)  in rpmhpd_set_performance_state()
344 		i--;  in rpmhpd_set_performance_state()
346 	if (pd->enabled) {  in rpmhpd_set_performance_state()
352 	pd->corner = i;  in rpmhpd_set_performance_state()
370 	buf = cmd_db_read_aux_data(rpmhpd->res_name, &rpmhpd->level_count);  in rpmhpd_update_level_mapping()
375 	rpmhpd->level_count >>= 1;  in rpmhpd_update_level_mapping()
377 	if (rpmhpd->level_count > RPMH_ARC_MAX_LEVELS)  in rpmhpd_update_level_mapping()
378 		return -EINVAL;  in rpmhpd_update_level_mapping()
380 	for (i = 0; i < rpmhpd->level_count; i++) {  in rpmhpd_update_level_mapping()
381 		rpmhpd->level[i] = buf[i];  in rpmhpd_update_level_mapping()
387 		if (i > 0 && rpmhpd->level[i] == 0) {  in rpmhpd_update_level_mapping()
388 			rpmhpd->level_count = i;  in rpmhpd_update_level_mapping()
391 		pr_debug("%s: ARC hlvl=%2d --> vlvl=%4u\n", rpmhpd->res_name, i,  in rpmhpd_update_level_mapping()
392 			 rpmhpd->level[i]);  in rpmhpd_update_level_mapping()
402 	struct device *dev = &pdev->dev;  in rpmhpd_probe()
409 		return -EINVAL;  in rpmhpd_probe()
411 	rpmhpds = desc->rpmhpds;  in rpmhpd_probe()
412 	num_pds = desc->num_pds;  in rpmhpd_probe()
416 		return -ENOMEM;  in rpmhpd_probe()
418 	data->domains = devm_kcalloc(dev, num_pds, sizeof(*data->domains),  in rpmhpd_probe()
420 	if (!data->domains)  in rpmhpd_probe()
421 		return -ENOMEM;  in rpmhpd_probe()
423 	data->num_domains = num_pds;  in rpmhpd_probe()
431 		rpmhpds[i]->dev = dev;  in rpmhpd_probe()
432 		rpmhpds[i]->addr = cmd_db_read_addr(rpmhpds[i]->res_name);  in rpmhpd_probe()
433 		if (!rpmhpds[i]->addr) {  in rpmhpd_probe()
435 				rpmhpds[i]->res_name);  in rpmhpd_probe()
436 			return -ENODEV;  in rpmhpd_probe()
439 		ret = cmd_db_read_slave_id(rpmhpds[i]->res_name);  in rpmhpd_probe()
442 			return -EINVAL;  in rpmhpd_probe()
449 		rpmhpds[i]->pd.power_off = rpmhpd_power_off;  in rpmhpd_probe()
450 		rpmhpds[i]->pd.power_on = rpmhpd_power_on;  in rpmhpd_probe()
451 		rpmhpds[i]->pd.set_performance_state = rpmhpd_set_performance_state;  in rpmhpd_probe()
452 		rpmhpds[i]->pd.opp_to_performance_state = rpmhpd_get_performance_state;  in rpmhpd_probe()
453 		pm_genpd_init(&rpmhpds[i]->pd, NULL, true);  in rpmhpd_probe()
455 		data->domains[i] = &rpmhpds[i]->pd;  in rpmhpd_probe()
462 		if (rpmhpds[i]->parent)  in rpmhpd_probe()
463 			pm_genpd_add_subdomain(rpmhpds[i]->parent,  in rpmhpd_probe()
464 					       &rpmhpds[i]->pd);  in rpmhpd_probe()
467 	return of_genpd_add_provider_onecell(pdev->dev.of_node, data);  in rpmhpd_probe()
472 		.name = "qcom-rpmhpd",