mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-10-30 23:58:51 +01:00
Fixed MTP to work with TWRP
This commit is contained in:
awab228
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
793
drivers/soc/samsung/pwrcal/power-cal.c
Normal file
793
drivers/soc/samsung/pwrcal/power-cal.c
Normal file
|
|
@ -0,0 +1,793 @@
|
|||
#include "pwrcal.h"
|
||||
#include "pwrcal-env.h"
|
||||
#include "pwrcal-pmu.h"
|
||||
#include "pwrcal-dfs.h"
|
||||
#include "pwrcal-clk.h"
|
||||
#include "pwrcal-vclk.h"
|
||||
#include "pwrcal-rae.h"
|
||||
#include "pwrcal-asv.h"
|
||||
#include <linux/exynos-ss.h>
|
||||
#include <trace/events/exynos.h>
|
||||
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
#include "./pmucal_mod/pmucal_system.h"
|
||||
#include "./pmucal_mod/pmucal_local.h"
|
||||
#include "./pmucal_mod/pmucal_cpu.h"
|
||||
#include "./pmucal_mod/pmucal_rae.h"
|
||||
#endif
|
||||
|
||||
#define MARGIN_UNIT 6250
|
||||
|
||||
int offset_percent;
|
||||
int set_big_volt;
|
||||
int set_lit_volt;
|
||||
int set_int_volt;
|
||||
int set_mif_volt;
|
||||
int set_g3d_volt;
|
||||
int set_disp_volt;
|
||||
int set_cam_volt;
|
||||
|
||||
static int __init get_big_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_big_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("big", get_big_volt);
|
||||
|
||||
static int __init get_lit_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_lit_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("lit", get_lit_volt);
|
||||
|
||||
static int __init get_int_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_int_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("int", get_int_volt);
|
||||
|
||||
static int __init get_mif_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_mif_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("mif", get_mif_volt);
|
||||
|
||||
static int __init get_g3d_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_g3d_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("g3d", get_g3d_volt);
|
||||
|
||||
static int __init get_disp_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_disp_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("disp", get_disp_volt);
|
||||
|
||||
static int __init get_cam_volt(char *str)
|
||||
{
|
||||
get_option(&str, &set_cam_volt);
|
||||
return 0;
|
||||
}
|
||||
early_param("cam", get_cam_volt);
|
||||
|
||||
static int __init get_offset_volt(char *str)
|
||||
{
|
||||
get_option(&str, &offset_percent);
|
||||
return 0;
|
||||
}
|
||||
early_param("volt_offset_percent", get_offset_volt);
|
||||
|
||||
static int set_percent_offset(int actual_volt)
|
||||
{
|
||||
int margin_volt = 0;
|
||||
if (offset_percent) {
|
||||
margin_volt = actual_volt + ((actual_volt * offset_percent)/100);
|
||||
if (offset_percent < -5) {
|
||||
if (((actual_volt * offset_percent)/100) % MARGIN_UNIT != 0)
|
||||
margin_volt -= ((actual_volt * offset_percent)/100) % MARGIN_UNIT;
|
||||
} else if (offset_percent < 0) {
|
||||
if (((actual_volt * offset_percent)/100) % MARGIN_UNIT != 0)
|
||||
margin_volt -= MARGIN_UNIT + ((actual_volt * offset_percent)/100) % MARGIN_UNIT;
|
||||
} else if (offset_percent <= 5) {
|
||||
if ((actual_volt * offset_percent/100) % MARGIN_UNIT != 0)
|
||||
margin_volt += MARGIN_UNIT - ((actual_volt * offset_percent)/100) % MARGIN_UNIT;
|
||||
} else {
|
||||
if (((actual_volt * offset_percent)/100) % MARGIN_UNIT != 0)
|
||||
margin_volt -= ((actual_volt * offset_percent)/100) % MARGIN_UNIT;
|
||||
}
|
||||
return margin_volt;
|
||||
} else {
|
||||
return actual_volt;
|
||||
}
|
||||
}
|
||||
|
||||
unsigned int cal_clk_get(char *name)
|
||||
{
|
||||
unsigned int ret;
|
||||
ret = _cal_vclk_get(name);
|
||||
|
||||
if (!ret)
|
||||
ret = _cal_clk_get(name);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
unsigned int cal_clk_is_enabled(unsigned int id)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cal_clk_setrate(unsigned int id, unsigned long rate)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
struct pwrcal_clk *clk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (vclk)
|
||||
return vclk_setrate(vclk, rate);
|
||||
|
||||
clk = cal_get_clk(id);
|
||||
if (clk)
|
||||
return pwrcal_clk_set_rate(clk, (unsigned long long)rate);
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
unsigned long cal_clk_getrate(unsigned int id)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
struct pwrcal_clk *clk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (vclk)
|
||||
return vclk_getrate(vclk);
|
||||
|
||||
clk = cal_get_clk(id);
|
||||
if (clk)
|
||||
return pwrcal_clk_get_rate(clk);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cal_clk_enable(unsigned int id)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
struct pwrcal_clk *clk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (vclk)
|
||||
return vclk_enable(vclk);
|
||||
|
||||
clk = cal_get_clk(id);
|
||||
if (clk)
|
||||
return pwrcal_clk_enable(clk);
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
int cal_clk_disable(unsigned int id)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
struct pwrcal_clk *clk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (vclk)
|
||||
return vclk_disable(vclk);
|
||||
|
||||
clk = cal_get_clk(id);
|
||||
if (clk)
|
||||
return pwrcal_clk_disable(clk);
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
int cal_pd_control(unsigned int id, int on)
|
||||
{
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
unsigned int index;
|
||||
|
||||
if ((id & 0xFFFF0000) != BLKPWR_MAGIC)
|
||||
return -1;
|
||||
|
||||
index = id & 0x0000FFFF;
|
||||
|
||||
if (on)
|
||||
return pmucal_local_enable(index);
|
||||
else
|
||||
return pmucal_local_disable(index);
|
||||
#else
|
||||
struct cal_pd *pd;
|
||||
unsigned int index;
|
||||
|
||||
if ((id & 0xFFFF0000) != BLKPWR_MAGIC)
|
||||
return -1;
|
||||
|
||||
index = id & 0x0000FFFF;
|
||||
|
||||
if (index >= pwrcal_blkpwr_size)
|
||||
return -1;
|
||||
|
||||
pd = pwrcal_blkpwr_list[index];
|
||||
|
||||
if (cal_pd_ops.pd_control)
|
||||
return cal_pd_ops.pd_control(pd, on);
|
||||
|
||||
return -1;
|
||||
#endif
|
||||
}
|
||||
|
||||
int cal_pd_status(unsigned int id)
|
||||
{
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
unsigned int index;
|
||||
|
||||
if ((id & 0xFFFF0000) != BLKPWR_MAGIC)
|
||||
return -1;
|
||||
|
||||
index = id & 0x0000FFFF;
|
||||
|
||||
return pmucal_local_is_enabled(index);
|
||||
#else
|
||||
struct cal_pd *pd;
|
||||
unsigned int index;
|
||||
|
||||
if ((id & 0xFFFF0000) != BLKPWR_MAGIC)
|
||||
return -1;
|
||||
|
||||
index = id & 0x0000FFFF;
|
||||
|
||||
if (index >= pwrcal_blkpwr_size)
|
||||
return -1;
|
||||
|
||||
pd = pwrcal_blkpwr_list[index];
|
||||
|
||||
if (cal_pd_ops.pd_status)
|
||||
return cal_pd_ops.pd_status(pd);
|
||||
|
||||
return -1;
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
|
||||
int cal_pm_enter(int mode)
|
||||
{
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
return pmucal_system_enter(mode);
|
||||
#else
|
||||
if (cal_pm_ops.pm_enter)
|
||||
cal_pm_ops.pm_enter(mode);
|
||||
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
int cal_pm_exit(int mode)
|
||||
{
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
return pmucal_system_exit(mode);
|
||||
#else
|
||||
if (cal_pm_ops.pm_exit)
|
||||
cal_pm_ops.pm_exit(mode);
|
||||
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
int cal_pm_earlywakeup(int mode)
|
||||
{
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
return pmucal_system_earlywakeup(mode);
|
||||
#else
|
||||
if (cal_pm_ops.pm_earlywakeup)
|
||||
cal_pm_ops.pm_earlywakeup(mode);
|
||||
|
||||
return 0;
|
||||
#endif
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
int cal_cpu_enable(unsigned int cpu)
|
||||
{
|
||||
return pmucal_cpu_enable(cpu);
|
||||
}
|
||||
|
||||
int cal_cpu_disable(unsigned int cpu)
|
||||
{
|
||||
return pmucal_cpu_disable(cpu);
|
||||
}
|
||||
|
||||
int cal_cpu_status(unsigned int cpu)
|
||||
{
|
||||
return pmucal_cpu_is_enabled(cpu);
|
||||
}
|
||||
|
||||
int cal_cluster_enable(unsigned int cluster)
|
||||
{
|
||||
return pmucal_cpu_cluster_enable(cluster);
|
||||
}
|
||||
|
||||
int cal_cluster_disable(unsigned int cluster)
|
||||
{
|
||||
return pmucal_cpu_cluster_disable(cluster);
|
||||
}
|
||||
|
||||
int cal_cluster_status(unsigned int cluster)
|
||||
{
|
||||
return pmucal_cpu_cluster_is_enabled(cluster);
|
||||
}
|
||||
#endif
|
||||
|
||||
unsigned int cal_dfs_get(char *name)
|
||||
{
|
||||
int id;
|
||||
|
||||
for (id = 0; id < vclk_dfs_list_size; id++)
|
||||
if (!strcmp(vclk_dfs_list[id]->vclk.name, name))
|
||||
return vclk_group_dfs + id;
|
||||
|
||||
return 0xFFFFFFFF;
|
||||
}
|
||||
|
||||
unsigned long cal_dfs_get_max_freq(unsigned int id)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return 0;
|
||||
|
||||
return dfs_get_max_freq(vclk);
|
||||
}
|
||||
|
||||
unsigned long cal_dfs_get_min_freq(unsigned int id)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return 0;
|
||||
|
||||
return dfs_get_min_freq(vclk);
|
||||
}
|
||||
|
||||
int cal_dfs_set_rate(unsigned int id, unsigned long rate)
|
||||
{
|
||||
struct pwrcal_vclk_dfs *dfs;
|
||||
struct vclk *vclk;
|
||||
unsigned long flag;
|
||||
int ret = 0;
|
||||
#ifdef CONFIG_EXYNOS_SNAPSHOT_CLK
|
||||
const char *name = "cal_dfs_set_rate";
|
||||
#endif
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return -1;
|
||||
|
||||
dfs = to_dfs(vclk);
|
||||
|
||||
spin_lock_irqsave(dfs->lock, flag);
|
||||
|
||||
if (!vclk->ref_count) {
|
||||
vclk->vfreq = rate;
|
||||
goto out;
|
||||
}
|
||||
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_IN);
|
||||
trace_exynos_clk_in(vclk, __func__);
|
||||
|
||||
if (dfs->table->private_trans)
|
||||
ret = dfs->table->private_trans(vclk->vfreq, rate, dfs->table);
|
||||
else if (vclk->ops->set_rate)
|
||||
ret = vclk->ops->set_rate(vclk, rate);
|
||||
else
|
||||
ret = -1;
|
||||
|
||||
if (!ret) {
|
||||
vclk->vfreq = rate;
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_OUT);
|
||||
trace_exynos_clk_out(vclk, __func__);
|
||||
} else {
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_ON);
|
||||
trace_exynos_clk_on(vclk, __func__);
|
||||
}
|
||||
out:
|
||||
spin_unlock_irqrestore(dfs->lock, flag);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int cal_dfs_set_rate_switch(unsigned int id, unsigned long switch_rate)
|
||||
{
|
||||
struct pwrcal_vclk_dfs *dfs;
|
||||
struct vclk *vclk;
|
||||
unsigned long flag;
|
||||
int ret = 0;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return -1;
|
||||
|
||||
dfs = to_dfs(vclk);
|
||||
|
||||
spin_lock_irqsave(dfs->lock, flag);
|
||||
|
||||
if (!vclk->ref_count) {
|
||||
ret = -1;
|
||||
goto out;
|
||||
}
|
||||
|
||||
if (dfs->table->private_switch)
|
||||
ret = dfs->table->private_switch(vclk->vfreq, switch_rate, dfs->table);
|
||||
else if (vclk->ops->set_rate)
|
||||
ret = vclk->ops->set_rate(vclk, switch_rate);
|
||||
else
|
||||
ret = -1;
|
||||
|
||||
if (!ret)
|
||||
vclk->vfreq = switch_rate;
|
||||
out:
|
||||
spin_unlock_irqrestore(dfs->lock, flag);
|
||||
return ret;
|
||||
}
|
||||
|
||||
unsigned long cal_dfs_cached_get_rate(unsigned int id)
|
||||
{
|
||||
struct pwrcal_vclk_dfs *dfs;
|
||||
struct vclk *vclk;
|
||||
unsigned long flag;
|
||||
unsigned long ret = 0;
|
||||
#ifdef CONFIG_EXYNOS_SNAPSHOT_CLK
|
||||
const char *name = "cal_dfs_get_rate";
|
||||
#endif
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return 0;
|
||||
|
||||
dfs = to_dfs(vclk);
|
||||
|
||||
spin_lock_irqsave(dfs->lock, flag);
|
||||
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_IN);
|
||||
trace_exynos_clk_in(vclk, __func__);
|
||||
|
||||
if (!vclk->ref_count) {
|
||||
pr_err("%s : %s reference count is zero \n", __func__, vclk->name);
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_ON);
|
||||
trace_exynos_clk_on(vclk, __func__);
|
||||
goto out;
|
||||
}
|
||||
|
||||
ret = vclk->vfreq;
|
||||
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_OUT);
|
||||
trace_exynos_clk_out(vclk, __func__);
|
||||
out:
|
||||
spin_unlock_irqrestore(dfs->lock, flag);
|
||||
return ret;
|
||||
}
|
||||
|
||||
unsigned long cal_dfs_get_rate(unsigned int id)
|
||||
{
|
||||
struct pwrcal_vclk_dfs *dfs;
|
||||
struct vclk *vclk;
|
||||
unsigned long flag;
|
||||
unsigned long ret = 0;
|
||||
#ifdef CONFIG_EXYNOS_SNAPSHOT_CLK
|
||||
const char *name = "cal_dfs_get_rate";
|
||||
#endif
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return 0;
|
||||
|
||||
dfs = to_dfs(vclk);
|
||||
|
||||
spin_lock_irqsave(dfs->lock, flag);
|
||||
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_IN);
|
||||
trace_exynos_clk_in(vclk, __func__);
|
||||
|
||||
if (!vclk->ref_count) {
|
||||
pr_err("%s : %s reference count is zero \n", __func__, vclk->name);
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_ON);
|
||||
trace_exynos_clk_on(vclk, __func__);
|
||||
goto out;
|
||||
}
|
||||
if (dfs->table->private_getrate)
|
||||
ret = dfs->table->private_getrate(dfs->table);
|
||||
else
|
||||
ret = vclk->ops->get_rate(vclk);
|
||||
|
||||
if (ret > 0) {
|
||||
vclk->vfreq = (unsigned long)ret;
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_OUT);
|
||||
trace_exynos_clk_out(vclk, __func__);
|
||||
} else {
|
||||
exynos_ss_clk(vclk, name, ESS_FLAG_ON);
|
||||
trace_exynos_clk_on(vclk, __func__);
|
||||
}
|
||||
out:
|
||||
spin_unlock_irqrestore(dfs->lock, flag);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static struct vclk_dfs_ops *get_dfsops(unsigned int id)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return NULL;
|
||||
|
||||
return (to_dfs(vclk))->dfsops;
|
||||
}
|
||||
|
||||
int cal_dfs_get_rate_table(unsigned int id, unsigned long *table)
|
||||
{
|
||||
struct vclk_dfs_ops *dfsops = get_dfsops(id);
|
||||
|
||||
if (dfsops)
|
||||
if (dfsops->get_rate_table)
|
||||
return dfsops->get_rate_table(table);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cal_dfs_get_asv_table(unsigned int id, unsigned int *table)
|
||||
{
|
||||
struct vclk_dfs_ops *dfsops = get_dfsops(id);
|
||||
int num_of_entry, i;
|
||||
int volt_offset = 0;
|
||||
int org_volt, percent_volt;
|
||||
|
||||
if (dfsops) {
|
||||
if (dfsops->get_margin_param)
|
||||
volt_offset = dfsops->get_margin_param(id);
|
||||
|
||||
if (dfsops->get_asv_table) {
|
||||
num_of_entry = dfsops->get_asv_table(table);
|
||||
|
||||
for (i = 0; i < num_of_entry; i++) {
|
||||
org_volt = (int)table[i];
|
||||
percent_volt = set_percent_offset(org_volt);
|
||||
table[i] = (unsigned int)(percent_volt + volt_offset);
|
||||
pr_info("L%2d: %7d uV, percent_offset(%d)-> %7d uV, volt_offset(%d uV)-> %7duV\n",
|
||||
i, org_volt, offset_percent,
|
||||
percent_volt, volt_offset, table[i]);
|
||||
}
|
||||
return num_of_entry;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void cal_dfs_set_volt_margin(unsigned int id, int volt)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
struct pwrcal_vclk_dfs *dfs;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
dfs = to_dfs(vclk);
|
||||
|
||||
dfs->volt_margin = volt;
|
||||
}
|
||||
|
||||
unsigned long cal_dfs_get_rate_by_member(unsigned int id,
|
||||
char *member,
|
||||
unsigned long rate)
|
||||
{
|
||||
struct vclk_dfs_ops *dfsops = get_dfsops(id);
|
||||
|
||||
if (dfsops)
|
||||
if (dfsops->get_target_rate)
|
||||
return dfsops->get_target_rate(member, rate);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cal_dfs_set_ema(unsigned int id, unsigned int volt)
|
||||
{
|
||||
struct vclk_dfs_ops *dfsops = get_dfsops(id);
|
||||
|
||||
if (dfsops)
|
||||
if (dfsops->set_ema)
|
||||
return dfsops->set_ema(volt);
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
int cal_dfs_ext_ctrl(unsigned int id,
|
||||
enum cal_dfs_ext_ops ops,
|
||||
int para)
|
||||
{
|
||||
struct vclk_dfs_ops *dfsops = get_dfsops(id);
|
||||
|
||||
if (dfsops) {
|
||||
switch (ops) {
|
||||
case cal_dfs_initsmpl:
|
||||
if (dfsops->init_smpl)
|
||||
return dfsops->init_smpl();
|
||||
break;
|
||||
case cal_dfs_setsmpl:
|
||||
if (dfsops->set_smpl)
|
||||
return dfsops->set_smpl();
|
||||
break;
|
||||
case cal_dfs_get_smplstatus:
|
||||
if (dfsops->get_smpl)
|
||||
return dfsops->get_smpl();
|
||||
break;
|
||||
case cal_dfs_dvs:
|
||||
if (dfsops->dvs)
|
||||
return dfsops->dvs(para);
|
||||
break;
|
||||
case cal_dfs_mif_is_dll_on:
|
||||
if (dfsops->is_dll_on)
|
||||
return dfsops->is_dll_on();
|
||||
break;
|
||||
case cal_dfs_cpu_idle_clock_down:
|
||||
if (dfsops->cpu_idle_clock_down)
|
||||
return dfsops->cpu_idle_clock_down(para);
|
||||
break;
|
||||
default:
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
return -1;
|
||||
|
||||
}
|
||||
|
||||
int cal_dfs_get_rate_asv_table(unsigned int id,
|
||||
struct dvfs_rate_volt *table)
|
||||
{
|
||||
struct vclk *vclk;
|
||||
struct pwrcal_vclk_dfs *dfs;
|
||||
int idx;
|
||||
int num_of_entry;
|
||||
unsigned long rate[48];
|
||||
unsigned int volt[48];
|
||||
int tmp;
|
||||
|
||||
vclk = cal_get_vclk(id);
|
||||
if (!vclk)
|
||||
return 0;
|
||||
|
||||
dfs = to_dfs(vclk);
|
||||
|
||||
num_of_entry = cal_dfs_get_rate_table(id, rate);
|
||||
if (num_of_entry == 0)
|
||||
return 0;
|
||||
|
||||
if (num_of_entry != cal_dfs_get_asv_table(id, volt))
|
||||
return 0;
|
||||
|
||||
for (idx = 0; idx < num_of_entry; idx++) {
|
||||
table[idx].rate = rate[idx];
|
||||
tmp = (int)(volt[idx]) + dfs->volt_margin;
|
||||
table[idx].volt = (unsigned int)tmp;
|
||||
}
|
||||
|
||||
return num_of_entry;
|
||||
}
|
||||
|
||||
void cal_asv_print_info(void)
|
||||
{
|
||||
if (cal_asv_ops.print_asv_info)
|
||||
cal_asv_ops.print_asv_info();
|
||||
}
|
||||
|
||||
void cal_rcc_print_info(void)
|
||||
{
|
||||
if (cal_asv_ops.print_rcc_info)
|
||||
cal_asv_ops.print_rcc_info();
|
||||
}
|
||||
|
||||
int cal_asv_set_rcc_table(void)
|
||||
{
|
||||
if (cal_asv_ops.set_rcc_table)
|
||||
return cal_asv_ops.set_rcc_table();
|
||||
return -1;
|
||||
}
|
||||
|
||||
void cal_asv_set_grp(unsigned int id, unsigned int asvgrp)
|
||||
{
|
||||
if (cal_asv_ops.set_grp)
|
||||
cal_asv_ops.set_grp(id, asvgrp);
|
||||
}
|
||||
|
||||
int cal_asv_get_grp(unsigned int id, unsigned int lv)
|
||||
{
|
||||
if (cal_asv_ops.get_grp)
|
||||
return cal_asv_ops.get_grp(id, lv);
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
void cal_asv_set_tablever(unsigned int version)
|
||||
{
|
||||
if (cal_asv_ops.set_tablever)
|
||||
cal_asv_ops.set_tablever(version);
|
||||
}
|
||||
|
||||
int cal_asv_get_tablever(void)
|
||||
{
|
||||
if (cal_asv_ops.get_tablever)
|
||||
return cal_asv_ops.get_tablever();
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
void cal_asv_set_ssa0(unsigned int id, unsigned int ssa0)
|
||||
{
|
||||
if (cal_asv_ops.set_ssa0)
|
||||
cal_asv_ops.set_ssa0(id, ssa0);
|
||||
}
|
||||
|
||||
int __init cal_init(void)
|
||||
{
|
||||
static int pwrcal_vclk_initialized;
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
int ret;
|
||||
#endif
|
||||
|
||||
if (pwrcal_vclk_initialized == 1)
|
||||
return 0;
|
||||
|
||||
cal_rae_init();
|
||||
clk_init();
|
||||
dfs_init();
|
||||
vclk_init();
|
||||
|
||||
if (cal_asv_ops.asv_init) {
|
||||
if (cal_asv_ops.asv_init())
|
||||
return -1;
|
||||
#ifdef PWRCAL_TARGET_LINUX
|
||||
if (cal_asv_ops.print_asv_info)
|
||||
cal_asv_ops.print_asv_info();
|
||||
#endif
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
ret = pmucal_rae_init();
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = pmucal_system_init();
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
#else
|
||||
if (cal_pm_ops.pm_init)
|
||||
cal_pm_ops.pm_init();
|
||||
#endif
|
||||
|
||||
vclk_unused_disable();
|
||||
|
||||
#ifdef CONFIG_PMUCAL_MOD
|
||||
ret = pmucal_local_init();
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = pmucal_cpu_init();
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
#else
|
||||
if (cal_pd_ops.pd_init)
|
||||
if (cal_pd_ops.pd_init())
|
||||
return -1;
|
||||
#endif
|
||||
|
||||
|
||||
pwrcal_vclk_initialized = 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue