^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /* Copyright (c) 2018, The Linux Foundation. All rights reserved.*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/pm_domain.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/of_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/pm_opp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <soc/qcom/cmd-db.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <soc/qcom/rpmh.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <dt-bindings/power/qcom-rpmpd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define domain_to_rpmhpd(domain) container_of(domain, struct rpmhpd, pd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define RPMH_ARC_MAX_LEVELS 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) * struct rpmhpd - top level RPMh power domain resource data structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) * @dev: rpmh power domain controller device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * @pd: generic_pm_domain corrresponding to the power domain
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * @parent: generic_pm_domain corrresponding to the parent's power domain
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * @peer: A peer power domain in case Active only Voting is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * supported
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * @active_only: True if it represents an Active only peer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) * @corner: current corner
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) * @active_corner: current active corner
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) * @enable_corner: lowest non-zero corner
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) * @level: An array of level (vlvl) to corner (hlvl) mappings
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * derived from cmd-db
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * @level_count: Number of levels supported by the power domain. max
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) * being 16 (0 - 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) * @enabled: true if the power domain is enabled
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) * @res_name: Resource name used for cmd-db lookup
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) * @addr: Resource address as looped up using resource name from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) * cmd-db
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) struct rpmhpd {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct generic_pm_domain pd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) struct generic_pm_domain *parent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) struct rpmhpd *peer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) const bool active_only;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) unsigned int corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) unsigned int active_corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) unsigned int enable_corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) u32 level[RPMH_ARC_MAX_LEVELS];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) size_t level_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) bool enabled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) const char *res_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) u32 addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct rpmhpd_desc {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct rpmhpd **rpmhpds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) size_t num_pds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static DEFINE_MUTEX(rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) /* SDM845 RPMH powerdomains */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static struct rpmhpd sdm845_ebi = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) .pd = { .name = "ebi", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) .res_name = "ebi.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) static struct rpmhpd sdm845_lmx = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) .pd = { .name = "lmx", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) .res_name = "lmx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static struct rpmhpd sdm845_lcx = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) .pd = { .name = "lcx", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) .res_name = "lcx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) static struct rpmhpd sdm845_gfx = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) .pd = { .name = "gfx", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) .res_name = "gfx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) static struct rpmhpd sdm845_mss = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) .pd = { .name = "mss", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) .res_name = "mss.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) static struct rpmhpd sdm845_mx_ao;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) static struct rpmhpd sdm845_mx = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) .pd = { .name = "mx", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) .peer = &sdm845_mx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) .res_name = "mx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static struct rpmhpd sdm845_mx_ao = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) .pd = { .name = "mx_ao", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) .active_only = true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) .peer = &sdm845_mx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) .res_name = "mx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) static struct rpmhpd sdm845_cx_ao;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static struct rpmhpd sdm845_cx = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) .pd = { .name = "cx", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) .peer = &sdm845_cx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) .parent = &sdm845_mx.pd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) .res_name = "cx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) static struct rpmhpd sdm845_cx_ao = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) .pd = { .name = "cx_ao", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) .active_only = true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) .peer = &sdm845_cx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) .parent = &sdm845_mx_ao.pd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) .res_name = "cx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static struct rpmhpd *sdm845_rpmhpds[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) [SDM845_EBI] = &sdm845_ebi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) [SDM845_MX] = &sdm845_mx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) [SDM845_MX_AO] = &sdm845_mx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) [SDM845_CX] = &sdm845_cx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) [SDM845_CX_AO] = &sdm845_cx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) [SDM845_LMX] = &sdm845_lmx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) [SDM845_LCX] = &sdm845_lcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) [SDM845_GFX] = &sdm845_gfx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) [SDM845_MSS] = &sdm845_mss,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) static const struct rpmhpd_desc sdm845_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) .rpmhpds = sdm845_rpmhpds,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) .num_pds = ARRAY_SIZE(sdm845_rpmhpds),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) /* SM8150 RPMH powerdomains */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) static struct rpmhpd sm8150_mmcx_ao;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) static struct rpmhpd sm8150_mmcx = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) .pd = { .name = "mmcx", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) .peer = &sm8150_mmcx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) .res_name = "mmcx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) static struct rpmhpd sm8150_mmcx_ao = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) .pd = { .name = "mmcx_ao", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) .active_only = true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) .peer = &sm8150_mmcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) .res_name = "mmcx.lvl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static struct rpmhpd *sm8150_rpmhpds[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) [SM8150_MSS] = &sdm845_mss,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) [SM8150_EBI] = &sdm845_ebi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) [SM8150_LMX] = &sdm845_lmx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) [SM8150_LCX] = &sdm845_lcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) [SM8150_GFX] = &sdm845_gfx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) [SM8150_MX] = &sdm845_mx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) [SM8150_MX_AO] = &sdm845_mx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) [SM8150_CX] = &sdm845_cx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) [SM8150_CX_AO] = &sdm845_cx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) [SM8150_MMCX] = &sm8150_mmcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) [SM8150_MMCX_AO] = &sm8150_mmcx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) static const struct rpmhpd_desc sm8150_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) .rpmhpds = sm8150_rpmhpds,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) .num_pds = ARRAY_SIZE(sm8150_rpmhpds),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) static struct rpmhpd *sm8250_rpmhpds[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) [SM8250_CX] = &sdm845_cx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) [SM8250_CX_AO] = &sdm845_cx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) [SM8250_EBI] = &sdm845_ebi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) [SM8250_GFX] = &sdm845_gfx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) [SM8250_LCX] = &sdm845_lcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) [SM8250_LMX] = &sdm845_lmx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) [SM8250_MMCX] = &sm8150_mmcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) [SM8250_MMCX_AO] = &sm8150_mmcx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) [SM8250_MX] = &sdm845_mx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) [SM8250_MX_AO] = &sdm845_mx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) static const struct rpmhpd_desc sm8250_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) .rpmhpds = sm8250_rpmhpds,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) .num_pds = ARRAY_SIZE(sm8250_rpmhpds),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) /* SC7180 RPMH powerdomains */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) static struct rpmhpd *sc7180_rpmhpds[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) [SC7180_CX] = &sdm845_cx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) [SC7180_CX_AO] = &sdm845_cx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) [SC7180_GFX] = &sdm845_gfx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) [SC7180_MX] = &sdm845_mx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) [SC7180_MX_AO] = &sdm845_mx_ao,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) [SC7180_LMX] = &sdm845_lmx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) [SC7180_LCX] = &sdm845_lcx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) [SC7180_MSS] = &sdm845_mss,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) static const struct rpmhpd_desc sc7180_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) .rpmhpds = sc7180_rpmhpds,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) .num_pds = ARRAY_SIZE(sc7180_rpmhpds),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) static const struct of_device_id rpmhpd_match_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) { .compatible = "qcom,sc7180-rpmhpd", .data = &sc7180_desc },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) { .compatible = "qcom,sdm845-rpmhpd", .data = &sdm845_desc },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) { .compatible = "qcom,sm8150-rpmhpd", .data = &sm8150_desc },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) { .compatible = "qcom,sm8250-rpmhpd", .data = &sm8250_desc },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) MODULE_DEVICE_TABLE(of, rpmhpd_match_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) static int rpmhpd_send_corner(struct rpmhpd *pd, int state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) unsigned int corner, bool sync)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) struct tcs_cmd cmd = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) .addr = pd->addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) .data = corner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) * Wait for an ack only when we are increasing the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) * perf state of the power domain
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if (sync)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) return rpmh_write(pd->dev, state, &cmd, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return rpmh_write_async(pd->dev, state, &cmd, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) static void to_active_sleep(struct rpmhpd *pd, unsigned int corner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) unsigned int *active, unsigned int *sleep)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) *active = corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) if (pd->active_only)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) *sleep = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) *sleep = *active;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) * This function is used to aggregate the votes across the active only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) * resources and its peers. The aggregated votes are sent to RPMh as
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) * ACTIVE_ONLY votes (which take effect immediately), as WAKE_ONLY votes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) * (applied by RPMh on system wakeup) and as SLEEP votes (applied by RPMh
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) * on system sleep).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) * We send ACTIVE_ONLY votes for resources without any peers. For others,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) * which have an active only peer, all 3 votes are sent.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) static int rpmhpd_aggregate_corner(struct rpmhpd *pd, unsigned int corner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) struct rpmhpd *peer = pd->peer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) unsigned int active_corner, sleep_corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) unsigned int this_active_corner = 0, this_sleep_corner = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) unsigned int peer_active_corner = 0, peer_sleep_corner = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) to_active_sleep(pd, corner, &this_active_corner, &this_sleep_corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) if (peer && peer->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) to_active_sleep(peer, peer->corner, &peer_active_corner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) &peer_sleep_corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) active_corner = max(this_active_corner, peer_active_corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) ret = rpmhpd_send_corner(pd, RPMH_ACTIVE_ONLY_STATE, active_corner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) active_corner > pd->active_corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) pd->active_corner = active_corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) if (peer) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) peer->active_corner = active_corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) ret = rpmhpd_send_corner(pd, RPMH_WAKE_ONLY_STATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) active_corner, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) sleep_corner = max(this_sleep_corner, peer_sleep_corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return rpmhpd_send_corner(pd, RPMH_SLEEP_STATE, sleep_corner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static int rpmhpd_power_on(struct generic_pm_domain *domain)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) struct rpmhpd *pd = domain_to_rpmhpd(domain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) unsigned int corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) mutex_lock(&rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) corner = max(pd->corner, pd->enable_corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) ret = rpmhpd_aggregate_corner(pd, corner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) pd->enabled = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) mutex_unlock(&rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) static int rpmhpd_power_off(struct generic_pm_domain *domain)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) struct rpmhpd *pd = domain_to_rpmhpd(domain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) mutex_lock(&rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) ret = rpmhpd_aggregate_corner(pd, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) pd->enabled = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) mutex_unlock(&rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) static int rpmhpd_set_performance_state(struct generic_pm_domain *domain,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) unsigned int level)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) struct rpmhpd *pd = domain_to_rpmhpd(domain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) int ret = 0, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) mutex_lock(&rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) for (i = 0; i < pd->level_count; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (level <= pd->level[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) * If the level requested is more than that supported by the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) * max corner, just set it to max anyway.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) if (i == pd->level_count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) i--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) if (pd->enabled) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) /* Ensure that the domain isn't turn off */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) if (i < pd->enable_corner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) i = pd->enable_corner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) ret = rpmhpd_aggregate_corner(pd, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) pd->corner = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) mutex_unlock(&rpmhpd_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) static unsigned int rpmhpd_get_performance_state(struct generic_pm_domain *genpd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) struct dev_pm_opp *opp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) return dev_pm_opp_get_level(opp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) static int rpmhpd_update_level_mapping(struct rpmhpd *rpmhpd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) const u16 *buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) buf = cmd_db_read_aux_data(rpmhpd->res_name, &rpmhpd->level_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) if (IS_ERR(buf))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) return PTR_ERR(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) /* 2 bytes used for each command DB aux data entry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) rpmhpd->level_count >>= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) if (rpmhpd->level_count > RPMH_ARC_MAX_LEVELS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) for (i = 0; i < rpmhpd->level_count; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) rpmhpd->level[i] = buf[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) /* Remember the first corner with non-zero level */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) if (!rpmhpd->level[rpmhpd->enable_corner] && rpmhpd->level[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) rpmhpd->enable_corner = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) * The AUX data may be zero padded. These 0 valued entries at
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) * the end of the map must be ignored.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) if (i > 0 && rpmhpd->level[i] == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) rpmhpd->level_count = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) pr_debug("%s: ARC hlvl=%2d --> vlvl=%4u\n", rpmhpd->res_name, i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) rpmhpd->level[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) static int rpmhpd_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) int i, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) size_t num_pds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) struct genpd_onecell_data *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) struct rpmhpd **rpmhpds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) const struct rpmhpd_desc *desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) desc = of_device_get_match_data(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) if (!desc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) rpmhpds = desc->rpmhpds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) num_pds = desc->num_pds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) data->domains = devm_kcalloc(dev, num_pds, sizeof(*data->domains),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) if (!data->domains)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) data->num_domains = num_pds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) for (i = 0; i < num_pds; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) if (!rpmhpds[i]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) dev_warn(dev, "rpmhpds[%d] is empty\n", i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) rpmhpds[i]->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) rpmhpds[i]->addr = cmd_db_read_addr(rpmhpds[i]->res_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (!rpmhpds[i]->addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) dev_err(dev, "Could not find RPMh address for resource %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) rpmhpds[i]->res_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) ret = cmd_db_read_slave_id(rpmhpds[i]->res_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) if (ret != CMD_DB_HW_ARC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) dev_err(dev, "RPMh slave ID mismatch\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) ret = rpmhpd_update_level_mapping(rpmhpds[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) rpmhpds[i]->pd.power_off = rpmhpd_power_off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) rpmhpds[i]->pd.power_on = rpmhpd_power_on;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) rpmhpds[i]->pd.set_performance_state = rpmhpd_set_performance_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) rpmhpds[i]->pd.opp_to_performance_state = rpmhpd_get_performance_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) pm_genpd_init(&rpmhpds[i]->pd, NULL, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) data->domains[i] = &rpmhpds[i]->pd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) /* Add subdomains */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) for (i = 0; i < num_pds; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) if (!rpmhpds[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) if (rpmhpds[i]->parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) pm_genpd_add_subdomain(rpmhpds[i]->parent,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) &rpmhpds[i]->pd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) return of_genpd_add_provider_onecell(pdev->dev.of_node, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) static struct platform_driver rpmhpd_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) .name = "qcom-rpmhpd",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) .of_match_table = rpmhpd_match_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) .suppress_bind_attrs = true,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) .probe = rpmhpd_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) static int __init rpmhpd_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) return platform_driver_register(&rpmhpd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) core_initcall(rpmhpd_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) MODULE_DESCRIPTION("Qualcomm Technologies, Inc. RPMh Power Domain Driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags