|
@@ -19,6 +19,12 @@
|
|
|
|
|
|
static unsigned int div2[] = { 1, 2, 4, 6, 8, 12, 16, 18,
|
|
|
24, 32, 36, 48 };
|
|
|
+
|
|
|
+static struct clk_div_mult_table cpg_div = {
|
|
|
+ .divisors = div2,
|
|
|
+ .nr_divisors = ARRAY_SIZE(div2),
|
|
|
+};
|
|
|
+
|
|
|
struct clk_priv {
|
|
|
unsigned int shift;
|
|
|
|
|
@@ -52,82 +58,23 @@ FRQMR_CLK_DATA(ifc, 28, 0x000e);
|
|
|
static unsigned long frqmr_recalc(struct clk *clk)
|
|
|
{
|
|
|
struct clk_priv *data = clk->priv;
|
|
|
- unsigned int idx;
|
|
|
-
|
|
|
- idx = (__raw_readl(FRQMR1) >> data->shift) & 0x000f;
|
|
|
-
|
|
|
- return clk->parent->rate / div2[idx];
|
|
|
-}
|
|
|
-
|
|
|
-static void frqmr_build_rate_table(struct clk *clk)
|
|
|
-{
|
|
|
- struct clk_priv *data = clk->priv;
|
|
|
- int i, entry;
|
|
|
-
|
|
|
- for (i = entry = 0; i < ARRAY_SIZE(div2); i++) {
|
|
|
- if ((data->div_bitmap & (1 << i)) == 0)
|
|
|
- continue;
|
|
|
+ unsigned int idx = (__raw_readl(FRQMR1) >> data->shift) & 0x000f;
|
|
|
|
|
|
- data->freq_table[entry].index = entry;
|
|
|
- data->freq_table[entry].frequency =
|
|
|
- clk->parent->rate / div2[i];
|
|
|
-
|
|
|
- entry++;
|
|
|
- }
|
|
|
-
|
|
|
- if (entry == 0) {
|
|
|
- pr_warning("clkfwk: failed to build frequency table "
|
|
|
- "for \"%s\" clk!\n", clk->name);
|
|
|
- return;
|
|
|
- }
|
|
|
-
|
|
|
- /* Termination entry */
|
|
|
- data->freq_table[entry].index = entry;
|
|
|
- data->freq_table[entry].frequency = CPUFREQ_TABLE_END;
|
|
|
+ clk_rate_table_build(clk, data->freq_table, ARRAY_SIZE(div2),
|
|
|
+ &cpg_div, &data->div_bitmap);
|
|
|
+
|
|
|
+ return data->freq_table[idx].frequency;
|
|
|
}
|
|
|
|
|
|
static long frqmr_round_rate(struct clk *clk, unsigned long rate)
|
|
|
{
|
|
|
struct clk_priv *data = clk->priv;
|
|
|
- unsigned long rate_error, rate_error_prev = ~0UL;
|
|
|
- unsigned long rate_best_fit = rate;
|
|
|
- unsigned long highest, lowest;
|
|
|
- int i;
|
|
|
-
|
|
|
- highest = lowest = 0;
|
|
|
-
|
|
|
- for (i = 0; data->freq_table[i].frequency != CPUFREQ_TABLE_END; i++) {
|
|
|
- unsigned long freq = data->freq_table[i].frequency;
|
|
|
-
|
|
|
- if (freq == CPUFREQ_ENTRY_INVALID)
|
|
|
- continue;
|
|
|
-
|
|
|
- if (freq > highest)
|
|
|
- highest = freq;
|
|
|
- if (freq < lowest)
|
|
|
- lowest = freq;
|
|
|
-
|
|
|
- rate_error = abs(freq - rate);
|
|
|
- if (rate_error < rate_error_prev) {
|
|
|
- rate_best_fit = freq;
|
|
|
- rate_error_prev = rate_error;
|
|
|
- }
|
|
|
-
|
|
|
- if (rate_error == 0)
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- if (rate >= highest)
|
|
|
- rate_best_fit = highest;
|
|
|
- if (rate <= lowest)
|
|
|
- rate_best_fit = lowest;
|
|
|
|
|
|
- return rate_best_fit;
|
|
|
+ return clk_rate_table_round(clk, data->freq_table, rate);
|
|
|
}
|
|
|
|
|
|
static struct clk_ops frqmr_clk_ops = {
|
|
|
.recalc = frqmr_recalc,
|
|
|
- .build_rate_table = frqmr_build_rate_table,
|
|
|
.round_rate = frqmr_round_rate,
|
|
|
};
|
|
|
|