static int exynos7_devfreq_disp_probe(struct platform_device *pdev)
{
int ret = 0;
struct devfreq_data_disp *data;
struct exynos_devfreq_platdata *plat_data;
data = kzalloc(sizeof(struct devfreq_data_disp), GFP_KERNEL);
if (data == NULL) {
pr_err("DEVFREQ(DISP) : Failed to allocate private data\n");
ret = -ENOMEM;
goto err_data;
}
ret = exynos7420_devfreq_disp_init(data);
if (ret) {
pr_err("DEVFREQ(DISP) : Failed to intialize data\n");
goto err_freqtable;
}
exynos7_devfreq_disp_profile.max_state = data->max_state;
exynos7_devfreq_disp_profile.freq_table = kzalloc(sizeof(int) * data->max_state, GFP_KERNEL);
if (exynos7_devfreq_disp_profile.freq_table == NULL) {
pr_err("DEVFREQ(DISP) : Failed to allocate freq table\n");
ret = -ENOMEM;
goto err_freqtable;
}
ret = exynos7_init_disp_table(&pdev->dev, data);
if (ret)
goto err_inittable;
platform_set_drvdata(pdev, data);
mutex_init(&data->lock);
data->volt_offset = 0;
data->dev = &pdev->dev;
data->vdd_disp_cam0 = regulator_get(NULL, "vdd_disp_cam0");
if (data->vdd_disp_cam0)
data->old_volt = regulator_get_voltage(data->vdd_disp_cam0);
data->devfreq = devfreq_add_device(data->dev,
&exynos7_devfreq_disp_profile,
"simple_ondemand",
&exynos7_devfreq_disp_governor_data);
plat_data = data->dev->platform_data;
data->devfreq->min_freq = plat_data->default_qos;
data->devfreq->max_freq = exynos7_devfreq_disp_governor_data.cal_qos_max;
data->cur_freq = exynos7_devfreq_disp_profile.initial_freq;
register_reboot_notifier(&exynos7_disp_reboot_notifier);
#ifdef CONFIG_EXYNOS_THERMAL
exynos_tmu_add_notifier(&data->tmu_notifier);
#endif
data->use_dvfs = true;
return ret;
err_inittable:
devfreq_remove_device(data->devfreq);
kfree(exynos7_devfreq_disp_profile.freq_table);
err_freqtable:
kfree(data);
err_data:
return ret;
}
static int exynos5_devfreq_isp_probe(struct platform_device *pdev)
{
int ret = 0;
struct devfreq_data_isp *data;
struct exynos_devfreq_platdata *plat_data;
struct opp *target_opp;
unsigned long freq;
unsigned long volt;
data = kzalloc(sizeof(struct devfreq_data_isp), GFP_KERNEL);
if (data == NULL) {
pr_err("DEVFREQ(ISP) : Failed to allocate private data\n");
ret = -ENOMEM;
goto err_data;
}
exynos5433_devfreq_isp_init(data);
exynos5_devfreq_isp_profile.max_state = data->max_state;
exynos5_devfreq_isp_profile.freq_table = kzalloc(sizeof(int) * data->max_state, GFP_KERNEL);
if (exynos5_devfreq_isp_profile.freq_table == NULL) {
pr_err("DEVFREQ(ISP) : Failed to allocate freq table\n");
ret = -ENOMEM;
goto err_freqtable;
}
ret = exynos5_init_isp_table(&pdev->dev, data);
if (ret)
goto err_inittable;
platform_set_drvdata(pdev, data);
mutex_init(&data->lock);
data->initial_freq = exynos5_devfreq_isp_profile.initial_freq;
data->volt_offset = 0;
isp_dev =
data->dev = &pdev->dev;
data->vdd_isp = regulator_get(NULL, "vdd_disp_cam0");
if (IS_ERR_OR_NULL(data->vdd_isp)) {
pr_err("DEVFREQ(ISP) : Failed to get regulator\n");
goto err_inittable;
}
freq = DEVFREQ_INITIAL_FREQ;
rcu_read_lock();
target_opp = devfreq_recommended_opp(data->dev, &freq, 0);
if (IS_ERR(target_opp)) {
rcu_read_unlock();
dev_err(data->dev, "DEVFREQ(ISP) : Invalid OPP to set voltage");
ret = PTR_ERR(target_opp);
goto err_opp;
}
volt = opp_get_voltage(target_opp);
#ifdef CONFIG_EXYNOS_THERMAL
volt = get_limit_voltage(volt, data->volt_offset);
#endif
rcu_read_unlock();
if (data->isp_set_volt)
data->isp_set_volt(data, volt, volt + VOLT_STEP, false);
data->devfreq = devfreq_add_device(data->dev,
&exynos5_devfreq_isp_profile,
"simple_ondemand",
&exynos5_devfreq_isp_governor_data);
plat_data = data->dev->platform_data;
data->devfreq->min_freq = plat_data->default_qos;
data->devfreq->max_freq = exynos5_devfreq_isp_governor_data.cal_qos_max;
register_reboot_notifier(&exynos5_isp_reboot_notifier);
#ifdef CONFIG_EXYNOS_THERMAL
data->tmu_notifier.notifier_call = exynos5_devfreq_isp_tmu_notifier;
exynos_tmu_add_notifier(&data->tmu_notifier);
#endif
data->use_dvfs = true;
return ret;
err_opp:
regulator_put(data->vdd_isp);
err_inittable:
devfreq_remove_device(data->devfreq);
kfree(exynos5_devfreq_isp_profile.freq_table);
err_freqtable:
kfree(data);
err_data:
return ret;
}
static int exynos5_devfreq_int_probe(struct platform_device *pdev)
{
int ret = 0;
struct devfreq_data_int *data;
struct devfreq_notifier_block *devfreq_nb;
struct exynos_devfreq_platdata *plat_data;
data = kzalloc(sizeof(struct devfreq_data_int), GFP_KERNEL);
if (data == NULL) {
pr_err("DEVFREQ(INT) : Failed to allocate private data\n");
ret = -ENOMEM;
goto err_data;
}
exynos5433_devfreq_int_init(data);
data->initial_freq = exynos5_devfreq_int_profile.initial_freq;
exynos5_devfreq_int_profile.freq_table = kzalloc(sizeof(int) * data->max_state, GFP_KERNEL);
if (exynos5_devfreq_int_profile.freq_table == NULL) {
pr_err("DEVFREQ(INT) : Failed to allocate freq table\n");
ret = -ENOMEM;
goto err_freqtable;
}
ret = exynos5_init_int_table(&pdev->dev, data);
if (ret)
goto err_inittable;
platform_set_drvdata(pdev, data);
mutex_init(&data->lock);
data->target_volt = get_match_volt(ID_INT, DEVFREQ_INITIAL_FREQ);
data->volt_constraint_isp = 0;
data->volt_offset = 0;
int_dev =
data->dev = &pdev->dev;
data->vdd_int = regulator_get(NULL, "vdd_int");
data->devfreq = devfreq_add_device(data->dev,
&exynos5_devfreq_int_profile,
"simple_ondemand",
&exynos5_devfreq_int_governor_data);
devfreq_nb = kzalloc(sizeof(struct devfreq_notifier_block), GFP_KERNEL);
if (devfreq_nb == NULL) {
pr_err("DEVFREQ(INT) : Failed to allocate notifier block\n");
ret = -ENOMEM;
goto err_nb;
}
devfreq_nb->df = data->devfreq;
devfreq_nb->nb.notifier_call = exynos5_devfreq_int_notifier;
exynos5433_devfreq_register(&devfreq_int_exynos);
exynos5433_ppmu_register_notifier(INT, &devfreq_nb->nb);
plat_data = data->dev->platform_data;
data->default_qos = plat_data->default_qos;
data->devfreq->min_freq = plat_data->default_qos;
data->devfreq->max_freq = devfreq_int_opp_list[0].freq;
register_reboot_notifier(&exynos5_int_reboot_notifier);
#ifdef CONFIG_EXYNOS_THERMAL
data->tmu_notifier.notifier_call = exynos5_devfreq_int_tmu_notifier;
exynos_tmu_add_notifier(&data->tmu_notifier);
#endif
data->use_dvfs = true;
return ret;
err_nb:
devfreq_remove_device(data->devfreq);
err_inittable:
kfree(exynos5_devfreq_int_profile.freq_table);
err_freqtable:
kfree(data);
err_data:
return ret;
}