forge/linux-uconsole
1
0
Fork 0
Code Issues 1 Pull requests Projects Releases Packages Wiki Activity Actions

soc: rockchip: opp_select: Implement rockchip_opp_set_low_length()

Browse source 
Signed-off-by: Finley Xiao <finley.xiao@rock-chips.com>
Change-Id: I17b57fe52bd764deec1400c88ac49a24b25ccaeb
This commit is contained in:
Finley Xiao 2024-06-21 17:06:28 +08:00 • committed by Tao Huang
commit 404d56f2e0
2 changed files with 49 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

40
drivers/soc/rockchip/rockchip_opp_select.c
View file

@ -2202,6 +2202,46 @@ int rockchip_set_intermediate_rate(struct device *dev,
}
EXPORT_SYMBOL(rockchip_set_intermediate_rate);
int rockchip_opp_set_low_length(struct device *dev, struct device_node *np,
struct rockchip_opp_info *opp_info)
{
struct clk *clk;
unsigned long old_rate;
unsigned int low_len_sel;
u32 opp_flag = 0;
int ret = 0;
if (opp_info->volt_sel < 0)
return 0;
clk = clk_get(dev, NULL);
if (IS_ERR(clk)) {
dev_warn(dev, "failed to get cpu clk\n");
return PTR_ERR(clk);
}
/* low speed grade should change to low length */
if (of_property_read_u32(np, "rockchip,pvtm-low-len-sel",
&low_len_sel))
goto out;
if (opp_info->volt_sel > low_len_sel)
goto out;
opp_flag = OPP_LENGTH_LOW;
old_rate = clk_get_rate(clk);
ret = clk_set_rate(clk, old_rate | opp_flag);
if (ret) {
dev_err(dev, "failed to change length\n");
goto out;
}
clk_set_rate(clk, old_rate);
out:
clk_put(clk);
return ret;
}
EXPORT_SYMBOL(rockchip_opp_set_low_length);
static int rockchip_opp_set_volt(struct device *dev, struct regulator *reg,
struct dev_pm_opp_supply *supply, char *reg_name)
{

9
include/soc/rockchip/rockchip_opp_select.h
View file

@ -166,6 +166,8 @@ int rockchip_set_intermediate_rate(struct device *dev,
struct clk *clk, unsigned long old_freq,
unsigned long new_freq, bool is_scaling_up,
bool is_set_clk);
int rockchip_opp_set_low_length(struct device *dev, struct device_node *np,
struct rockchip_opp_info *opp_info);
int rockchip_opp_config_regulators(struct device *dev,
struct dev_pm_opp *old_opp,
struct dev_pm_opp *new_opp,
@ -253,6 +255,13 @@ rockchip_set_intermediate_rate(struct device *dev,
return -EOPNOTSUPP;
}
static inline int
rockchip_opp_set_low_length(struct device *dev, struct device_node *np,
struct rockchip_opp_info *opp_info)
{
return -EOPNOTSUPP;
}
static inline int
rockchip_opp_config_regulators(struct device *dev,
struct dev_pm_opp *old_opp,