Vishwanath BS <[email protected]> writes: > From: Thara Gopinath <[email protected]> > > This patch also introduces omap3_mpu_set_rate, omap3_iva_set_rate, > omap3_l3_set_rate, omap3_mpu_get_rate, omap3_iva_get_rate, > omap3_l3_get_rate as device specific set rate and get rate > APIs for OMAP3 mpu, iva and l3_main devices. This patch also > calls into omap_device_populate_rate_fns during system init to register > various set_rate and get_rate APIs with the omap device layer > > Signed-off-by: Thara Gopinath <[email protected]> > --- > arch/arm/mach-omap2/pm.c | 71 > ++++++++++++++++++++++++++++++++++++++++++++++ > 1 files changed, 71 insertions(+), 0 deletions(-) > > diff --git a/arch/arm/mach-omap2/pm.c b/arch/arm/mach-omap2/pm.c > index d5a102c..1b94ad4 100644 > --- a/arch/arm/mach-omap2/pm.c > +++ b/arch/arm/mach-omap2/pm.c > @@ -23,6 +23,9 @@ > #include "powerdomain.h" > #include "clockdomain.h" > #include "pm.h" > +#include "cm2xxx_3xxx.h" > +#include "cm-regbits-34xx.h" > +#include "prm.h" > > static struct omap_device_pm_latency *pm_lats; > > @@ -31,6 +34,8 @@ static struct device *iva_dev; > static struct device *l3_dev; > static struct device *dsp_dev; > > +static struct clk *dpll1_clk, *dpll2_clk, *dpll3_clk; > + > struct device *omap2_get_mpuss_device(void) > { > WARN_ON_ONCE(!mpu_dev); > @@ -77,6 +82,55 @@ static int _init_omap_device(char *name, struct device > **new_dev) > return 0; > } > > +static unsigned long omap3_mpu_get_rate(struct device *dev) > +{ > + return dpll1_clk->rate; > +} > + > +static int omap3_mpu_set_rate(struct device *dev, unsigned long rate) > +{ > + int ret; > + > + ret = clk_set_rate(dpll1_clk, rate); > + if (ret) { > + dev_warn(dev, "%s: Unable to set rate to %ld\n", > + __func__, rate); > + return ret; > + } > + > + return 0; > +} > + > +static int omap3_iva_set_rate(struct device *dev, unsigned long rate) > +{ > + return clk_set_rate(dpll2_clk, rate); > +} > + > +static unsigned long omap3_iva_get_rate(struct device *dev) > +{ > + return dpll2_clk->rate; > +} > + > +static int omap3_l3_set_rate(struct device *dev, unsigned long rate) > +{ > + int l3_div; > + > + l3_div = omap2_cm_read_mod_reg(CORE_MOD, CM_CLKSEL) & > + OMAP3430_CLKSEL_L3_MASK; > + > + return clk_set_rate(dpll3_clk, rate * l3_div); > +} > + > +static unsigned long omap3_l3_get_rate(struct device *dev) > +{ > + int l3_div; > + > + l3_div = omap2_cm_read_mod_reg(CORE_MOD, CM_CLKSEL) & > + OMAP3430_CLKSEL_L3_MASK; > + return dpll3_clk->rate / l3_div; > +} > + > + > /* > * Build omap_devices for processors and bus. > */ > @@ -90,6 +144,23 @@ static void omap2_init_processor_devices(void) > } else { > _init_omap_device("l3_main", &l3_dev); > } > + > + if (cpu_is_omap34xx()) { > + dpll1_clk = clk_get(NULL, "dpll1_ck"); > + dpll2_clk = clk_get(NULL, "dpll2_ck"); > + dpll3_clk = clk_get(NULL, "dpll3_m2_ck");
Should check return value of clk_get() calls. > + if (mpu_dev) > + omap_device_register_dvfs_callbacks(mpu_dev, > + omap3_mpu_set_rate, omap3_mpu_get_rate); > + if (iva_dev) > + omap_device_register_dvfs_callbacks(iva_dev, > + omap3_iva_set_rate, omap3_iva_get_rate); > + if (l3_dev) > + omap_device_register_dvfs_callbacks(l3_dev, > + omap3_l3_set_rate, omap3_l3_get_rate); > + > + } > } > > /* Types of sleep_switch used in omap_set_pwrdm_state */ Kevin -- To unsubscribe from this list: send the line "unsubscribe linux-omap" in the body of a message to [email protected] More majordomo info at http://vger.kernel.org/majordomo-info.html
