@@ -271,6 +271,8 @@ int omap3_noncore_dpll_set_rate_and_parent(struct clk_hw *hw,
unsigned long rate,
unsigned long parent_rate,
u8 index);
+int omap3_noncore_dpll_set_spread_spectrum(struct clk_hw *hw,
+ const struct clk_spread_spectrum *ss_conf);
int omap3_noncore_dpll_determine_rate(struct clk_hw *hw,
struct clk_rate_request *req);
int omap2_dpll_determine_rate(struct clk_hw *hw, struct clk_rate_request *req);
@@ -51,6 +51,7 @@ static const struct clk_ops dpll_ck_ops = {
.set_parent = &omap3_noncore_dpll_set_parent,
.set_rate_and_parent = &omap3_noncore_dpll_set_rate_and_parent,
.determine_rate = &omap3_noncore_dpll_determine_rate,
+ .set_spread_spectrum = &omap3_noncore_dpll_set_spread_spectrum,
.get_parent = &omap2_init_dpll_parent,
.save_context = &omap3_noncore_dpll_save_context,
.restore_context = &omap3_noncore_dpll_restore_context,
@@ -63,6 +64,7 @@ static const struct clk_ops dpll_no_gate_ck_ops = {
.set_parent = &omap3_noncore_dpll_set_parent,
.set_rate_and_parent = &omap3_noncore_dpll_set_rate_and_parent,
.determine_rate = &omap3_noncore_dpll_determine_rate,
+ .set_spread_spectrum = &omap3_noncore_dpll_set_spread_spectrum,
.save_context = &omap3_noncore_dpll_save_context,
.restore_context = &omap3_noncore_dpll_restore_context
};
@@ -348,12 +350,6 @@ static void __init of_ti_dpll_setup(struct device_node *node,
if (ti_clk_get_reg_addr(node, ssc_clk_index++,
&dd->ssc_modfreq_reg))
goto cleanup;
-
- of_property_read_u32(node, "ti,ssc-modfreq-hz",
- &dd->ssc_modfreq);
- of_property_read_u32(node, "ti,ssc-deltam", &dd->ssc_deltam);
- dd->ssc_downspread =
- of_property_read_bool(node, "ti,ssc-downspread");
}
if (of_property_read_bool(node, "ti,low-power-stop"))
@@ -295,30 +295,32 @@ static void _lookup_sddiv(struct clk_hw_omap *clk, u8 *sd_div, u16 m, u8 n)
* omap3_noncore_dpll_ssc_program - set spread-spectrum clocking registers
* @clk: struct clk * of DPLL to set
*
- * Enable the DPLL spread spectrum clocking if frequency modulation and
- * frequency spreading have been set, otherwise disable it.
+ * Enable the DPLL spread spectrum clocking according to the configuration
+ * set by omap3_noncore_dpll_set_spread_spectrum(), otherwise disable it.
*/
static void omap3_noncore_dpll_ssc_program(struct clk_hw_omap *clk)
{
struct dpll_data *dd = clk->dpll_data;
+ const struct clk_spread_spectrum *conf = &dd->ssc_conf;
+ bool downspread = conf->method == CLK_SPREAD_DOWN;
unsigned long ref_rate;
u32 v, ctrl, mod_freq_divider, exponent, mantissa;
u32 deltam_step, deltam_ceil;
ctrl = ti_clk_ll_ops->clk_readl(&dd->control_reg);
- if (dd->ssc_modfreq && dd->ssc_deltam) {
+ if (conf->method != CLK_SPREAD_NO) {
ctrl |= dd->ssc_enable_mask;
- if (dd->ssc_downspread)
+ if (downspread)
ctrl |= dd->ssc_downspread_mask;
else
ctrl &= ~dd->ssc_downspread_mask;
ref_rate = clk_hw_get_rate(dd->clk_ref);
mod_freq_divider =
- (ref_rate / dd->last_rounded_n) / (4 * dd->ssc_modfreq);
- if (dd->ssc_modfreq > (ref_rate / 70))
+ (ref_rate / dd->last_rounded_n) / (4 * conf->modfreq_hz);
+ if (conf->modfreq_hz > (ref_rate / 70))
pr_warn("clock: SSC modulation frequency of DPLL %s greater than %ld\n",
__clk_get_name(clk->hw.clk), ref_rate / 70);
@@ -337,9 +339,10 @@ static void omap3_noncore_dpll_ssc_program(struct clk_hw_omap *clk)
v |= exponent << __ffs(dd->ssc_modfreq_exp_mask);
ti_clk_ll_ops->clk_writel(v, &dd->ssc_modfreq_reg);
- deltam_step = dd->last_rounded_m * dd->ssc_deltam;
- deltam_step /= 10;
- if (dd->ssc_downspread)
+ /* spread_bp is in permyriad, convert to percent first */
+ deltam_step = dd->last_rounded_m * conf->spread_bp;
+ deltam_step /= 100;
+ if (downspread)
deltam_step /= 2;
deltam_step <<= __ffs(dd->ssc_deltam_int_mask);
@@ -353,7 +356,7 @@ static void omap3_noncore_dpll_ssc_program(struct clk_hw_omap *clk)
if (deltam_step & dd->ssc_deltam_frac_mask)
deltam_ceil++;
- if ((dd->ssc_downspread &&
+ if ((downspread &&
((dd->last_rounded_m - (2 * deltam_ceil)) < 20 ||
dd->last_rounded_m > 2045)) ||
((dd->last_rounded_m - deltam_ceil) < 20 ||
@@ -682,6 +685,44 @@ int omap3_noncore_dpll_set_rate(struct clk_hw *hw, unsigned long rate,
return ret;
}
+/**
+ * omap3_noncore_dpll_set_spread_spectrum - set the DPLL SSC configuration
+ * @hw: pointer to the clock to set the spread spectrum configuration for
+ * @ss_conf: spread spectrum configuration
+ *
+ * Stores the spread spectrum clocking (SSC) configuration of the DPLL. The
+ * configuration is programmed along with the DPLL multiplier and divider
+ * at the next rate change. The hardware supports center-spread and
+ * down-spread only. Returns 0 on success, or a negative error value on
+ * failure.
+ */
+int omap3_noncore_dpll_set_spread_spectrum(struct clk_hw *hw,
+ const struct clk_spread_spectrum *ss_conf)
+{
+ struct clk_hw_omap *clk = to_clk_hw_omap(hw);
+ struct dpll_data *dd = clk->dpll_data;
+
+ if (!dd || !dd->ssc_enable_mask)
+ return -EOPNOTSUPP;
+
+ switch (ss_conf->method) {
+ case CLK_SPREAD_NO:
+ break;
+ case CLK_SPREAD_CENTER:
+ case CLK_SPREAD_DOWN:
+ if (!ss_conf->modfreq_hz || !ss_conf->spread_bp)
+ return -EINVAL;
+ break;
+ default:
+ /* Up-spread is not supported by the hardware */
+ return -EINVAL;
+ }
+
+ dd->ssc_conf = *ss_conf;
+
+ return 0;
+}
+
/**
* omap3_noncore_dpll_set_rate_and_parent - set rate and parent for a DPLL clock
* @hw: pointer to the clock to set rate and parent for
@@ -65,10 +65,7 @@ struct clk_omap_reg {
* @ssc_enable_mask: mask of the DPLL SSC enable bit in @control_reg
* @ssc_downspread_mask: mask of the DPLL SSC low frequency only bit in
* @control_reg
- * @ssc_modfreq: the DPLL SSC frequency modulation in kHz
- * @ssc_deltam: the DPLL SSC frequency spreading in permille (10th of percent)
- * @ssc_downspread: require the only low frequency spread of the DPLL in SSC
- * mode
+ * @ssc_conf: the DPLL SSC configuration, as set by clk_hw_set_spread_spectrum()
* @flags: DPLL type/features (see below)
*
* Possible values for @flags:
@@ -124,9 +121,7 @@ struct dpll_data {
u32 ssc_modfreq_exp_mask;
u32 ssc_enable_mask;
u32 ssc_downspread_mask;
- u32 ssc_modfreq;
- u32 ssc_deltam;
- bool ssc_downspread;
+ struct clk_spread_spectrum ssc_conf;
u8 flags;
};