shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-05 18:41:58 +09:00
Code Issues Packages Projects Releases Wiki Activity

soc: rockchip: system_monitor: Add multiple regulator support for early min volt

Browse Source 
Signed-off-by: Finley Xiao <finley.xiao@rock-chips.com>
Change-Id: Ife4bfeea52b1f857c36dfe523c8269f70b9e9005
This commit is contained in:
Finley Xiao
2024-05-25 09:10:35 +08:00
committed by Tao Huang
parent 6b63014398
commit d16a3075b4
2 changed files with 58 additions and 26 deletions
Download Patch File Download Diff File Expand all files Collapse all files

80
drivers/soc/rockchip/rockchip_system_monitor.c
View File

@@ -840,8 +840,22 @@ static int monitor_device_parse_status_config(struct device_node *np,
static int monitor_device_parse_early_min_volt(struct device_node *np,
struct monitor_dev_info *info)
{
return of_property_read_u32(np, "rockchip,early-min-microvolt",
&info->early_min_volt);
const char *prop_name = "rockchip,early-min-microvolt";
int count = 0, ret = 0;
count = of_property_count_u32_elems(np, prop_name);
if (count <= 0)
return -EINVAL;
if (count > 1) {
ret = of_property_read_u32_index(np, prop_name, 1,
&info->early_min_volt[1]);
if (ret)
return ret;
}
return of_property_read_u32_index(np, prop_name, 0,
&info->early_min_volt[0]);
}
static int monitor_device_parse_dt(struct device *dev,
@@ -1186,18 +1200,48 @@ rockchip_system_monitor_early_regulator_init(struct monitor_dev_info *info)
struct rockchip_opp_info *opp_info = devp->opp_info;
struct regulator *reg;
struct regulator_dev *rdev;
int i;
if (!opp_info || !opp_info->regulators)
return;
if (!info->early_min_volt)
for (i = 0; i < opp_info->regulator_count; i++) {
if (!info->early_min_volt[i] || i >= 2)
continue;
rdev = opp_info->regulators[i]->rdev;
reg = regulator_get(NULL, get_rdev_name(rdev));
if (!IS_ERR_OR_NULL(reg)) {
info->early_reg[i] = reg;
reg->voltage[PM_SUSPEND_ON].min_uV = info->early_min_volt[i];
reg->voltage[PM_SUSPEND_ON].max_uV = rdev->constraints->max_uV;
}
}
}
static void
rockchip_system_monitor_early_regulator_uninit(struct monitor_dev_info *info)
{
struct monitor_dev_profile *devp = info->devp;
struct rockchip_opp_info *opp_info = devp->opp_info;
struct regulator_dev *rdev;
int min_uV, max_uV;
int ret, i;
if (!opp_info || !opp_info->regulators)
return;
rdev = opp_info->regulators[0]->rdev;
reg = regulator_get(NULL, get_rdev_name(rdev));
if (!IS_ERR_OR_NULL(reg)) {
info->early_reg = reg;
reg->voltage[PM_SUSPEND_ON].min_uV = info->early_min_volt;
reg->voltage[PM_SUSPEND_ON].max_uV = rdev->constraints->max_uV;
for (i = 0; i < opp_info->regulator_count; i++) {
if (!info->early_reg[i] || i >= 2)
continue;
rdev = info->early_reg[i]->rdev;
min_uV = rdev->constraints->min_uV;
max_uV = rdev->constraints->max_uV;
ret = regulator_set_voltage(info->early_reg[i], min_uV, max_uV);
if (ret)
dev_err(&rdev->dev,
"%s: failed to set volt\n", __func__);
regulator_put(info->early_reg[i]);
info->early_reg[i] = NULL;
}
}
@@ -1338,6 +1382,7 @@ void rockchip_system_monitor_unregister(struct monitor_dev_info *info)
return;
down_write(&mdev_list_sem);
rockchip_system_monitor_early_regulator_uninit(info);
list_del(&info->node);
up_write(&mdev_list_sem);
@@ -1737,23 +1782,10 @@ static struct notifier_block rockchip_monitor_ebc_nb = {
static void system_monitor_early_min_volt_function(struct work_struct *work)
{
struct monitor_dev_info *info;
struct regulator_dev *rdev;
int min_uV, max_uV;
int ret;
down_read(&mdev_list_sem);
list_for_each_entry(info, &monitor_dev_list, node) {
if (!info->early_min_volt || !info->early_reg)
continue;
rdev = info->early_reg->rdev;
min_uV = rdev->constraints->min_uV;
max_uV = rdev->constraints->max_uV;
ret = regulator_set_voltage(info->early_reg, min_uV, max_uV);
if (ret)
dev_err(&rdev->dev,
"%s: failed to set volt\n", __func__);
regulator_put(info->early_reg);
}
list_for_each_entry(info, &monitor_dev_list, node)
rockchip_system_monitor_early_regulator_uninit(info);
up_read(&mdev_list_sem);
}

4
include/soc/rockchip/rockchip_system_monitor.h
View File

@@ -104,7 +104,7 @@ struct monitor_dev_info {
struct freq_qos_request min_sta_freq_req;
struct freq_qos_request max_sta_freq_req;
struct dev_pm_qos_request dev_max_freq_req;
struct regulator *early_reg;
struct regulator *early_reg[2];
unsigned long low_limit;
unsigned long high_limit;
unsigned long max_volt;
@@ -114,7 +114,7 @@ struct monitor_dev_info {
unsigned int reboot_freq;
unsigned int status_min_limit;
unsigned int status_max_limit;
unsigned int early_min_volt;
unsigned int early_min_volt[2];
int low_temp;
int high_temp;
int temp_hysteresis;