mirror of
https://github.com/torvalds/linux.git
synced 2026-05-28 17:13:52 +02:00
soc: qcom: rpmpd: Add sync_state
Add a sync_state implementation, very similar to the one already present in the RPMhPD driver. Signed-off-by: Konrad Dybcio <konrad.dybcio@linaro.org> Link: https://lore.kernel.org/r/20230619-topic-rpmpd_syncstate-v1-1-54f986cf9444@linaro.org Signed-off-by: Bjorn Andersson <andersson@kernel.org>
This commit is contained in:
parent
2976eec238
commit
98c8b3efac
|
|
@ -58,6 +58,7 @@ struct rpmpd {
|
||||||
struct qcom_smd_rpm *rpm;
|
struct qcom_smd_rpm *rpm;
|
||||||
unsigned int max_state;
|
unsigned int max_state;
|
||||||
__le32 key;
|
__le32 key;
|
||||||
|
bool state_synced;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct rpmpd_desc {
|
struct rpmpd_desc {
|
||||||
|
|
@ -823,7 +824,11 @@ static int rpmpd_aggregate_corner(struct rpmpd *pd)
|
||||||
unsigned int this_active_corner = 0, this_sleep_corner = 0;
|
unsigned int this_active_corner = 0, this_sleep_corner = 0;
|
||||||
unsigned int peer_active_corner = 0, peer_sleep_corner = 0;
|
unsigned int peer_active_corner = 0, peer_sleep_corner = 0;
|
||||||
|
|
||||||
to_active_sleep(pd, pd->corner, &this_active_corner, &this_sleep_corner);
|
/* Clamp to the highest corner/level if sync_state isn't done yet */
|
||||||
|
if (!pd->state_synced)
|
||||||
|
this_active_corner = this_sleep_corner = pd->max_state - 1;
|
||||||
|
else
|
||||||
|
to_active_sleep(pd, pd->corner, &this_active_corner, &this_sleep_corner);
|
||||||
|
|
||||||
if (peer && peer->enabled)
|
if (peer && peer->enabled)
|
||||||
to_active_sleep(peer, peer->corner, &peer_active_corner,
|
to_active_sleep(peer, peer->corner, &peer_active_corner,
|
||||||
|
|
@ -973,11 +978,38 @@ static int rpmpd_probe(struct platform_device *pdev)
|
||||||
return of_genpd_add_provider_onecell(pdev->dev.of_node, data);
|
return of_genpd_add_provider_onecell(pdev->dev.of_node, data);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void rpmpd_sync_state(struct device *dev)
|
||||||
|
{
|
||||||
|
const struct rpmpd_desc *desc = of_device_get_match_data(dev);
|
||||||
|
struct rpmpd **rpmpds = desc->rpmpds;
|
||||||
|
struct rpmpd *pd;
|
||||||
|
unsigned int i;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
mutex_lock(&rpmpd_lock);
|
||||||
|
for (i = 0; i < desc->num_pds; i++) {
|
||||||
|
pd = rpmpds[i];
|
||||||
|
if (!pd)
|
||||||
|
continue;
|
||||||
|
|
||||||
|
pd->state_synced = true;
|
||||||
|
|
||||||
|
if (!pd->enabled)
|
||||||
|
pd->corner = 0;
|
||||||
|
|
||||||
|
ret = rpmpd_aggregate_corner(pd);
|
||||||
|
if (ret)
|
||||||
|
dev_err(dev, "failed to sync %s: %d\n", pd->pd.name, ret);
|
||||||
|
}
|
||||||
|
mutex_unlock(&rpmpd_lock);
|
||||||
|
}
|
||||||
|
|
||||||
static struct platform_driver rpmpd_driver = {
|
static struct platform_driver rpmpd_driver = {
|
||||||
.driver = {
|
.driver = {
|
||||||
.name = "qcom-rpmpd",
|
.name = "qcom-rpmpd",
|
||||||
.of_match_table = rpmpd_match_table,
|
.of_match_table = rpmpd_match_table,
|
||||||
.suppress_bind_attrs = true,
|
.suppress_bind_attrs = true,
|
||||||
|
.sync_state = rpmpd_sync_state,
|
||||||
},
|
},
|
||||||
.probe = rpmpd_probe,
|
.probe = rpmpd_probe,
|
||||||
};
|
};
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue
Block a user