OMAP3+: VP: move timing calculation/config into VP init

[pandora-kernel.git] / arch / arm / mach-omap2 / vp.c

diff --git a/arch/arm/mach-omap2/vp.c b/arch/arm/mach-omap2/vp.c
index 297d094..ea61a47 100644 (file)
--- a/arch/arm/mach-omap2/vp.c
+++ b/arch/arm/mach-omap2/vp.c
@@ -50,7 +50,7 @@ void __init omap_vp_init(struct voltagedomain *voltdm)
 {
        struct omap_vp_instance *vp = voltdm->vp;
        struct omap_vdd_info *vdd = voltdm->vdd;
-       u32 vp_val;
+       u32 vp_val, sys_clk_rate, timeout_val, waittime;
 
        if (!voltdm->read || !voltdm->write) {
                pr_err("%s: No read/write API for accessing vdd_%s regs\n",
@@ -58,6 +58,27 @@ void __init omap_vp_init(struct voltagedomain *voltdm)
                return;
        }
 
+       vp->enabled = false;
+
+       /* Divide to avoid overflow */
+       sys_clk_rate = voltdm->sys_clk.rate / 1000;
+
+       vdd->vp_rt_data.vpconfig_erroroffset =
+               (voltdm->pmic->vp_erroroffset <<
+                __ffs(voltdm->vp->common->vpconfig_erroroffset_mask));
+
+       timeout_val = (sys_clk_rate * voltdm->pmic->vp_timeout_us) / 1000;
+       vdd->vp_rt_data.vlimitto_timeout = timeout_val;
+       vdd->vp_rt_data.vlimitto_vddmin = voltdm->pmic->vp_vddmin;
+       vdd->vp_rt_data.vlimitto_vddmax = voltdm->pmic->vp_vddmax;
+
+       waittime = ((voltdm->pmic->step_size / voltdm->pmic->slew_rate) *
+                   sys_clk_rate) / 1000;
+       vdd->vp_rt_data.vstepmin_smpswaittimemin = waittime;
+       vdd->vp_rt_data.vstepmax_smpswaittimemax = waittime;
+       vdd->vp_rt_data.vstepmin_stepmin = voltdm->pmic->vp_vstepmin;
+       vdd->vp_rt_data.vstepmax_stepmax = voltdm->pmic->vp_vstepmax;
+
        vp_val = vdd->vp_rt_data.vpconfig_erroroffset |
                (vdd->vp_rt_data.vpconfig_errorgain <<
                 __ffs(vp->common->vpconfig_errorgain_mask)) |