diff mbox

[v6,2/3] clk: introduce the common clock framework

Message ID 20120312115117.GN3852@pengutronix.de
State New
Headers show

Commit Message

Sascha Hauer March 12, 2012, 11:51 a.m. UTC
On Sun, Mar 11, 2012 at 02:24:46PM -0700, Turquette, Mike wrote:
> On Sun, Mar 11, 2012 at 4:34 AM, Sascha Hauer <s.hauer@pengutronix.de> wrote:
> > Hi Mike,
> >
> > I was about to give my tested-by when I decided to test the set_rate
> > function. Unfortunately this is broken for several reasons. I'll try
> > to come up with a fixup series later the day.
> 
> I haven't tested clk_set_rate since V4, but I also haven't changed the
> code appreciably.  I'll retest on my end also.
> 
> > On Fri, Mar 09, 2012 at 11:54:23PM -0800, Mike Turquette wrote:
> >> +     /* find the new rate and see if parent rate should change too */
> >> +     WARN_ON(!clk->ops->round_rate);
> >> +
> >> +     new_rate = clk->ops->round_rate(clk->hw, rate, &parent_new_rate);
> >
> > You don't need a WARN_ON when you derefence clk->ops->round_rate anyway.
> 
> Agreed that the WARN_ON should not be there.
> 
> The v6 Documentation/clk.txt states that .round_rate is mandatory for
> clocks that can adjust their rate, but I need to clarify this a bit
> more.  Ideally we want to be able to call clk_set_rate on any clock
> and get a changed rate (if possible) by either adjusting that clocks
> rate direction (e.g. a PLL or an adjustable divider) or by propagating
> __clk_set_rate up the parents (assuming of course that
> CLK_SET_RATE_PARENT flag is set appropriately).
> 
> > Also, even when the current clock does not have a set_rate function it
> > can still change its rate when the CLK_SET_RATE_PARENT is set.
> 
> Correct.  I'll clean this up and make the documentation a bit more
> verbose on when .set_rate/.round_rate/.recalc_rate are mandatory.
> 
> >
> >> +
> >> +     /* NOTE: pre-rate change notifications will stack */
> >> +     if (clk->notifier_count)
> >> +             ret = __clk_notify(clk, PRE_RATE_CHANGE, clk->rate, new_rate);
> >> +
> >> +     if (ret == NOTIFY_BAD)
> >> +             return clk;
> >> +
> >> +     /* speculate rate changes down the tree */
> >> +     hlist_for_each_entry(child, tmp, &clk->children, child_node) {
> >> +             ret = __clk_speculate_rates(child, new_rate);
> >> +             if (ret == NOTIFY_BAD)
> >> +                     return clk;
> >> +     }
> >> +
> >> +     /* change the rate of this clk */
> >> +     if (clk->ops->set_rate)
> >> +             ret = clk->ops->set_rate(clk->hw, new_rate);
> >
> > I don't know the reason why you change the child clock before the parent
> > clock, but it cannot work since this clock will change its rate based on
> > the old parent rate and not the new one.
> 
> This depends on the .round_rate implementation, which I admit to
> having lost some sleep over.  A clever .round_rate will request the
> "intermediate" rate for a clock when propagating a request to change
> the parent rate later on.  Take for instance the following:
> 
> pll @ 200MHz (locked)
>     |
> parent @ 100MHz (can divide by 1 or 2; currently divider is 2)
>     |
> child @ 25MHz (can divide by 2 or 4; currently divider is 4)
> 
> If we want child to run at 100MHz then the desirable configuration
> would be to have parent divide-by-1 and child divide-by-2.  When we
> call,
> 
> clk_set_rate(child, 100MHz);
> 
> Its .round_rate should return 50MHz, and &parent_new_rate should be
> 200MHz.  So 50MHz is an "intermediate" rate, but it gets us the
> divider we want.  And in fact 50MHz reflects reality because that will
> be the rate of child until the parent propagation completes and we can
> adjust parent's dividers.  (this is one reason why I prefer for
> pre-rate change notifiers to stack on top of each other).
> 
> So now that &parent_new_rate is > 0, __clk_set_rate will propagate the
> request up and parent's .round_rate will simply return 200MHz and
> leave it's own &parent_new_rate at 0.  This will change from
> divide-by-2 to divide-by-1 and from this highest point in the tree we
> will propagate post-rate change notifiers downstream, as part of the
> recalc_rate tree walk.
> 
> I have tested this with OMAP4's CPUfreq driver and I think, while
> complicated, it is a sound way to approach the problem.  Maybe the API
> can be cleaned up, if you have any suggestions.

I cannot see all implications this way will have. All this rate
propagation is more complex than I thought it would be. I tried another
approach on the weekend which basically does not try to do all in a
single recursion but instead sets the rate in multiple steps:

1) call a function which calculates all new rates of affected clocks
   in a rate change and safes the value in a clk->new_rate field. This
   function returns the topmost clock which has to be changed.
2) starting from the topmost clock notify all clients. This walks the
   whole subtree even if a notfifier refuses the change. If necessary
   we can walk the whole subtree again to abort the change.
3) actually change rates starting from the topmost clocks and notify
   all clients on the way. I changed the set_rate callback to void.
   Instead of failing (what is failing in case of set_rate? The clock
   will still have some rate) I check for the result with
   clk_ops->recalc_rate.

In the end what's more important than the implementation details is that
it actually works. I created a little test module which sets up two
cascaded dividers, tries to change the rate at the output and checks the
result.  We might want to add something like this (and maybe similar
tests for reparenting and other stuff) to the generic clock framework
later.  It's good to have something generic to test the framework with
without depending on some particular SoC.

Sascha

8<----------------------------------------------------

clk: Add clock test module

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
---
 drivers/clk/clk-test.c |  169 ++++++++++++++++++++++++++++++++++++++++++++++++
 1 files changed, 169 insertions(+), 0 deletions(-)
 create mode 100644 drivers/clk/clk-test.c

Comments

Mike Turquette March 13, 2012, 3:16 a.m. UTC | #1
On Mon, Mar 12, 2012 at 4:51 AM, Sascha Hauer <s.hauer@pengutronix.de> wrote:
> On Sun, Mar 11, 2012 at 02:24:46PM -0700, Turquette, Mike wrote:
>> On Sun, Mar 11, 2012 at 4:34 AM, Sascha Hauer <s.hauer@pengutronix.de> wrote:
>> > Hi Mike,
>> >
>> > I was about to give my tested-by when I decided to test the set_rate
>> > function. Unfortunately this is broken for several reasons. I'll try
>> > to come up with a fixup series later the day.
>>
>> I haven't tested clk_set_rate since V4, but I also haven't changed the
>> code appreciably.  I'll retest on my end also.
>>
>> > On Fri, Mar 09, 2012 at 11:54:23PM -0800, Mike Turquette wrote:
>> >> +     /* find the new rate and see if parent rate should change too */
>> >> +     WARN_ON(!clk->ops->round_rate);
>> >> +
>> >> +     new_rate = clk->ops->round_rate(clk->hw, rate, &parent_new_rate);
>> >
>> > You don't need a WARN_ON when you derefence clk->ops->round_rate anyway.
>>
>> Agreed that the WARN_ON should not be there.
>>
>> The v6 Documentation/clk.txt states that .round_rate is mandatory for
>> clocks that can adjust their rate, but I need to clarify this a bit
>> more.  Ideally we want to be able to call clk_set_rate on any clock
>> and get a changed rate (if possible) by either adjusting that clocks
>> rate direction (e.g. a PLL or an adjustable divider) or by propagating
>> __clk_set_rate up the parents (assuming of course that
>> CLK_SET_RATE_PARENT flag is set appropriately).
>>
>> > Also, even when the current clock does not have a set_rate function it
>> > can still change its rate when the CLK_SET_RATE_PARENT is set.
>>
>> Correct.  I'll clean this up and make the documentation a bit more
>> verbose on when .set_rate/.round_rate/.recalc_rate are mandatory.
>>
>> >
>> >> +
>> >> +     /* NOTE: pre-rate change notifications will stack */
>> >> +     if (clk->notifier_count)
>> >> +             ret = __clk_notify(clk, PRE_RATE_CHANGE, clk->rate, new_rate);
>> >> +
>> >> +     if (ret == NOTIFY_BAD)
>> >> +             return clk;
>> >> +
>> >> +     /* speculate rate changes down the tree */
>> >> +     hlist_for_each_entry(child, tmp, &clk->children, child_node) {
>> >> +             ret = __clk_speculate_rates(child, new_rate);
>> >> +             if (ret == NOTIFY_BAD)
>> >> +                     return clk;
>> >> +     }
>> >> +
>> >> +     /* change the rate of this clk */
>> >> +     if (clk->ops->set_rate)
>> >> +             ret = clk->ops->set_rate(clk->hw, new_rate);
>> >
>> > I don't know the reason why you change the child clock before the parent
>> > clock, but it cannot work since this clock will change its rate based on
>> > the old parent rate and not the new one.
>>
>> This depends on the .round_rate implementation, which I admit to
>> having lost some sleep over.  A clever .round_rate will request the
>> "intermediate" rate for a clock when propagating a request to change
>> the parent rate later on.  Take for instance the following:
>>
>> pll @ 200MHz (locked)
>>     |
>> parent @ 100MHz (can divide by 1 or 2; currently divider is 2)
>>     |
>> child @ 25MHz (can divide by 2 or 4; currently divider is 4)
>>
>> If we want child to run at 100MHz then the desirable configuration
>> would be to have parent divide-by-1 and child divide-by-2.  When we
>> call,
>>
>> clk_set_rate(child, 100MHz);
>>
>> Its .round_rate should return 50MHz, and &parent_new_rate should be
>> 200MHz.  So 50MHz is an "intermediate" rate, but it gets us the
>> divider we want.  And in fact 50MHz reflects reality because that will
>> be the rate of child until the parent propagation completes and we can
>> adjust parent's dividers.  (this is one reason why I prefer for
>> pre-rate change notifiers to stack on top of each other).
>>
>> So now that &parent_new_rate is > 0, __clk_set_rate will propagate the
>> request up and parent's .round_rate will simply return 200MHz and
>> leave it's own &parent_new_rate at 0.  This will change from
>> divide-by-2 to divide-by-1 and from this highest point in the tree we
>> will propagate post-rate change notifiers downstream, as part of the
>> recalc_rate tree walk.
>>
>> I have tested this with OMAP4's CPUfreq driver and I think, while
>> complicated, it is a sound way to approach the problem.  Maybe the API
>> can be cleaned up, if you have any suggestions.
>
> I cannot see all implications this way will have. All this rate
> propagation is more complex than I thought it would be.

Hi Sascha,

Yes it is very complicated.  The solution I have now (recursive
__clk_set_rate, clever .round_rate which requests parent rate) was not
something I arrived at immediately.

I decided to validate the v6 patches more thoroughly today, based on
your claim that clk_set_rate is broken and here is what I found:

1) clk_set_rate works.  I pulled in the latest OMAP4 CPUfreq code into
my common clk branch and it Just Worked.  This is a dumb
implementation involving no upwards parent propagation, and the clock
changing is of type struct clk_hw_omap (relocking a PLL)

2) while I was at it I verified the rate change notifiers +
clk_set_parent, which also work (I had not touched these since v4 and
wanted to make sure nothing was broken)

Here is where things get interesting.  I tried the same parent rate
propagation via CPUfreq that I had done previously in the v4 series
(http://article.gmane.org/gmane.linux.ports.arm.omap/68225), but this
time it didn't work.  The difference is that back in v4 all of my
clocks in that propagation chain were struct clk_hw_omap, none of them
were any of the basic clock types.  Now in v6, one of the clocks in
the chain is struct clk_divider.  I started looking at the divider's
.round_rate code and for the case where CLK_PARENT_SET_RATE flag is
set the code doesn't make any sense.  I spent some time today trying
to fix struct clk_divider's .round_rate implementation and came to
realize that there might not be a sane default for how such code
should work.  A sane default for the common divider that works
correctly on OMAP may not be what you want on iMX.

To illustrate: if CLK_SET_RATE_PARENT flag is set for my clk_divider
I'd really like to divide by 1 and pass the exact same rate that was
requested for my clk_divider up to the parent.  But the existing
divider code tries to find the largest div for clk_divider and request
a faster rate from the parent (well, I assume this is what it is
supposed to do as the code doesn't quite get this right).

Do you have any ideas on this?  Also, can you verify if this is what
was failing for you, or maybe provide a log if the bug you mentioned
exists elsewhere?  An extreme solution to the problem would be for
clk_divider to not support the CLK_SET_PARENT flag if we cannot agree
on a sane default for this behavior.  I like the idea of the divider
choosing the smallest div possible and requesting the balance from the
parent, but I need feedback from others on that point.  For non-rate
adjustable clocks (clk_gate in particular) it is very easy to continue
supporting this flag as the .round_rate implementation should just be
a "pass through" up to the parent.  In fact this behavior is what some
of my omap clocks are doing and that is why parent propagation for
CPUfreq was working for me back in v4.

> I tried another
> approach on the weekend which basically does not try to do all in a
> single recursion but instead sets the rate in multiple steps:
>
> 1) call a function which calculates all new rates of affected clocks
>   in a rate change and safes the value in a clk->new_rate field. This
>   function returns the topmost clock which has to be changed.
> 2) starting from the topmost clock notify all clients. This walks the
>   whole subtree even if a notfifier refuses the change. If necessary
>   we can walk the whole subtree again to abort the change.
> 3) actually change rates starting from the topmost clocks and notify
>   all clients on the way. I changed the set_rate callback to void.
>   Instead of failing (what is failing in case of set_rate? The clock
>   will still have some rate) I check for the result with
>   clk_ops->recalc_rate.

I've considered something like this for "clock groups", especially
when the set of clocks changing are all on the same device and the
permutations are well known ahead of time.  Is this working for you
now?

>
> In the end what's more important than the implementation details is that
> it actually works. I created a little test module which sets up two
> cascaded dividers, tries to change the rate at the output and checks the
> result.  We might want to add something like this (and maybe similar
> tests for reparenting and other stuff) to the generic clock framework
> later.  It's good to have something generic to test the framework with
> without depending on some particular SoC.

Agreed about the generic test.  I'm not taking it into the current
series, but we can grow the test cases and submit them later on.

Thanks,
Mike

>
> Sascha
>
> 8<----------------------------------------------------
>
> clk: Add clock test module
>
> Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
> ---
>  drivers/clk/clk-test.c |  169 ++++++++++++++++++++++++++++++++++++++++++++++++
>  1 files changed, 169 insertions(+), 0 deletions(-)
>  create mode 100644 drivers/clk/clk-test.c
>
> diff --git a/drivers/clk/clk-test.c b/drivers/clk/clk-test.c
> new file mode 100644
> index 0000000..6f901fd
> --- /dev/null
> +++ b/drivers/clk/clk-test.c
> @@ -0,0 +1,169 @@
> +#include <linux/spinlock.h>
> +#include <linux/clk-provider.h>
> +#include <linux/clk.h>
> +#include <linux/module.h>
> +
> +/*
> + * We build a fixed rate source clock with two cascaded 2bit dividers:
> + *
> + * f1 -> div1 -> div2
> + *
> + * and try set the rate of div2 from 0Hz to f1 + 1 Hz.
> + *
> + * This makes the following resulting dividers possible:
> + *
> + * 1, 2, 4, 6, 8, 9, 12, 16
> + *
> + * Sometimes there are different results possible due to integer maths.
> + * For example if we have an input frequency of 100Hz and request an
> + * output of 16Hz the best divider values would be 2 and 4 resulting
> + * in a real frequency of 12.5Hz. We also accept 2 and 3 as result
> + * because 100 / (3 * 2) = 16.6667 which is too high, but multiplying
> + * 16 * 3 * 2 results in 96Hz which is lower than 100Hz.
> + *
> + */
> +
> +static unsigned long div1_reg, div2_reg;
> +
> +static struct clk *f1, *div1, *div2;
> +
> +static DEFINE_SPINLOCK(imx_ccm_lock);
> +
> +//#define FIXED_RATE 144
> +#define FIXED_RATE 100
> +
> +static inline struct clk *register_divider(const char *name, const char *parent,
> +               void __iomem *reg, u8 shift, u8 width)
> +{
> +       return clk_register_divider(NULL, name, parent, CLK_SET_RATE_PARENT,
> +                       reg, shift, width, 0, &imx_ccm_lock);
> +}
> +
> +static unsigned long divs[] = {
> +       1, 2, 3, 4, 6, 8, 9, 12, 16,
> +};
> +
> +static int check_rounded_rate(unsigned long want, unsigned long rounded)
> +{
> +       int i, j;
> +       unsigned long best1 = 0, best2 = 0, now;
> +
> +       if (want > FIXED_RATE) {
> +               best1 = best2 = FIXED_RATE;
> +               goto found2;
> +       }
> +
> +       for (i = 1; i <= 4; i++) {
> +               for (j = 1; j <= 4; j++) {
> +                       now = FIXED_RATE / i / j;
> +                       if (now <= want && now > best1)
> +                               best1 = now;
> +               }
> +       }
> +
> +       if (!best1)
> +               best1 = (FIXED_RATE / 4) / 4;
> +
> +       for (i = 0; i < ARRAY_SIZE(divs); i++) {
> +               if (FIXED_RATE <= want * divs[i]) {
> +                       best2 = FIXED_RATE / divs[i];
> +                       goto found2;
> +               }
> +       }
> +
> +       if (!best2)
> +               best2 = FIXED_RATE / 16;
> +found2:
> +       if (rounded != best1 && rounded != best2) {
> +               if (best1 == best2)
> +                       printk("clk-test: wanted rate %ld, best result would be %ld,"
> +                                       " but we have %ld\n",
> +                                       want, best1, rounded);
> +               else
> +                       printk("clk-test: wanted rate %ld, best result would be %ld or %ld,"
> +                                       " but we have %ld\n",
> +                                       want, best1, best2, rounded);
> +               return -EINVAL;
> +       }
> +
> +       return 0;
> +}
> +
> +static int check_real_rate(unsigned long rate)
> +{
> +       unsigned long realrate1, realrate2;
> +
> +       realrate1 = FIXED_RATE / (div1_reg + 1) / (div2_reg + 1);
> +       realrate2 = FIXED_RATE / ((div1_reg + 1) * (div2_reg + 1));
> +
> +       if (rate != realrate1 && rate != realrate2) {
> +               if (realrate1 == realrate2)
> +                       printk("clk-test: divider returns rate %ld, but instead has %ld\n",
> +                                       rate, realrate1);
> +               else
> +                       printk("clk-test: divider returns rate %ld, but instead has %ld or %ld\n",
> +                                       rate, realrate1, realrate2);
> +               return -EINVAL;
> +       }
> +
> +       return 0;
> +}
> +
> +static int set_rate_test(void)
> +{
> +       unsigned long i, rate, rounded;
> +       int ret, errors = 0;
> +
> +       for (i = 0; i < FIXED_RATE + 1; i++) {
> +               rounded = clk_round_rate(div2, i);
> +               ret = check_rounded_rate(i, rounded);
> +               if (ret)
> +                       errors++;
> +               ret = clk_set_rate(div2, i);
> +               if (ret) {
> +                       printk("%s: setting rate of div2 to %ld failed with %d\n",
> +                                       __func__, i, ret);
> +                       errors++;
> +               }
> +
> +               rate = clk_get_rate(div2);
> +
> +               if (rounded != rate) {
> +                       printk("clk_test: wanted %ld, core rounded to %ld, have now: %ld\n",
> +                                       i, rounded, rate);
> +                       errors++;
> +               }
> +
> +               ret = check_real_rate(rate);
> +               if (ret)
> +                       errors++;
> +       }
> +
> +       return errors;
> +}
> +
> +static int clk_test_init(void)
> +{
> +       int errors;
> +
> +       f1 = clk_register_fixed_rate(NULL, "f1", NULL, CLK_IS_ROOT, FIXED_RATE);
> +       div1 = register_divider("div1", "f1", &div1_reg, 0, 2);
> +       div2 = register_divider("div2", "div1", &div2_reg, 0, 2);
> +
> +       if (!f1 || !div1 || !div2) {
> +               printk("clk-test: failed to register clocks\n");
> +               return -EINVAL;
> +       }
> +
> +       errors = set_rate_test();
> +
> +       printk("clk-test: finished with %d errors\n", errors);
> +#if 0
> +       /* Oh, oh */
> +       clk_unregister(f1);
> +       clk_unregister(div1);
> +       clk_unregister(div2);
> +#endif
> +       return -EINVAL;
> +}
> +subsys_initcall(clk_test_init);
> --
> 1.7.9.1
>
>
>
> --
> Pengutronix e.K.                           |                             |
> Industrial Linux Solutions                 | http://www.pengutronix.de/  |
> Peiner Str. 6-8, 31137 Hildesheim, Germany | Phone: +49-5121-206917-0    |
> Amtsgericht Hildesheim, HRA 2686           | Fax:   +49-5121-206917-5555 |
diff mbox

Patch

diff --git a/drivers/clk/clk-test.c b/drivers/clk/clk-test.c
new file mode 100644
index 0000000..6f901fd
--- /dev/null
+++ b/drivers/clk/clk-test.c
@@ -0,0 +1,169 @@ 
+#include <linux/spinlock.h>
+#include <linux/clk-provider.h>
+#include <linux/clk.h>
+#include <linux/module.h>
+
+/*
+ * We build a fixed rate source clock with two cascaded 2bit dividers:
+ *
+ * f1 -> div1 -> div2
+ *
+ * and try set the rate of div2 from 0Hz to f1 + 1 Hz.
+ *
+ * This makes the following resulting dividers possible:
+ *
+ * 1, 2, 4, 6, 8, 9, 12, 16
+ *
+ * Sometimes there are different results possible due to integer maths.
+ * For example if we have an input frequency of 100Hz and request an
+ * output of 16Hz the best divider values would be 2 and 4 resulting
+ * in a real frequency of 12.5Hz. We also accept 2 and 3 as result
+ * because 100 / (3 * 2) = 16.6667 which is too high, but multiplying
+ * 16 * 3 * 2 results in 96Hz which is lower than 100Hz.
+ *
+ */
+
+static unsigned long div1_reg, div2_reg;
+
+static struct clk *f1, *div1, *div2;
+
+static DEFINE_SPINLOCK(imx_ccm_lock);
+
+//#define FIXED_RATE 144
+#define FIXED_RATE 100
+
+static inline struct clk *register_divider(const char *name, const char *parent,
+		void __iomem *reg, u8 shift, u8 width)
+{
+	return clk_register_divider(NULL, name, parent, CLK_SET_RATE_PARENT,
+			reg, shift, width, 0, &imx_ccm_lock);
+}
+
+static unsigned long divs[] = {
+	1, 2, 3, 4, 6, 8, 9, 12, 16,
+};
+
+static int check_rounded_rate(unsigned long want, unsigned long rounded)
+{
+	int i, j;
+	unsigned long best1 = 0, best2 = 0, now;
+
+	if (want > FIXED_RATE) {
+		best1 = best2 = FIXED_RATE;
+		goto found2;
+	}
+
+	for (i = 1; i <= 4; i++) {
+		for (j = 1; j <= 4; j++) {
+			now = FIXED_RATE / i / j;
+			if (now <= want && now > best1)
+				best1 = now;
+		}
+	}
+
+	if (!best1)
+		best1 = (FIXED_RATE / 4) / 4;
+
+	for (i = 0; i < ARRAY_SIZE(divs); i++) {
+		if (FIXED_RATE <= want * divs[i]) {
+			best2 = FIXED_RATE / divs[i];
+			goto found2;
+		}
+	}
+
+	if (!best2)
+		best2 = FIXED_RATE / 16;
+found2:
+	if (rounded != best1 && rounded != best2) {
+		if (best1 == best2)
+			printk("clk-test: wanted rate %ld, best result would be %ld,"
+					" but we have %ld\n",
+					want, best1, rounded);
+		else
+			printk("clk-test: wanted rate %ld, best result would be %ld or %ld,"
+					" but we have %ld\n",
+					want, best1, best2, rounded);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int check_real_rate(unsigned long rate)
+{
+	unsigned long realrate1, realrate2;
+
+	realrate1 = FIXED_RATE / (div1_reg + 1) / (div2_reg + 1);
+	realrate2 = FIXED_RATE / ((div1_reg + 1) * (div2_reg + 1));
+
+	if (rate != realrate1 && rate != realrate2) {
+		if (realrate1 == realrate2)
+			printk("clk-test: divider returns rate %ld, but instead has %ld\n",
+					rate, realrate1);
+		else
+			printk("clk-test: divider returns rate %ld, but instead has %ld or %ld\n",
+					rate, realrate1, realrate2);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static int set_rate_test(void)
+{
+	unsigned long i, rate, rounded;
+	int ret, errors = 0;
+
+	for (i = 0; i < FIXED_RATE + 1; i++) {
+		rounded = clk_round_rate(div2, i);
+		ret = check_rounded_rate(i, rounded);
+		if (ret)
+			errors++;
+		ret = clk_set_rate(div2, i);
+		if (ret) {
+			printk("%s: setting rate of div2 to %ld failed with %d\n",
+					__func__, i, ret);
+			errors++;
+		}
+
+		rate = clk_get_rate(div2);
+
+		if (rounded != rate) {
+			printk("clk_test: wanted %ld, core rounded to %ld, have now: %ld\n",
+					i, rounded, rate);
+			errors++;
+		}
+
+		ret = check_real_rate(rate);
+		if (ret)
+			errors++;
+	}
+
+	return errors;
+}
+
+static int clk_test_init(void)
+{
+	int errors;
+
+	f1 = clk_register_fixed_rate(NULL, "f1", NULL, CLK_IS_ROOT, FIXED_RATE);
+	div1 = register_divider("div1", "f1", &div1_reg, 0, 2);
+	div2 = register_divider("div2", "div1", &div2_reg, 0, 2);
+
+	if (!f1 || !div1 || !div2) {
+		printk("clk-test: failed to register clocks\n");
+		return -EINVAL;
+	}
+
+	errors = set_rate_test();
+
+	printk("clk-test: finished with %d errors\n", errors);
+#if 0
+	/* Oh, oh */
+	clk_unregister(f1);
+	clk_unregister(div1);
+	clk_unregister(div2);
+#endif
+	return -EINVAL;
+}
+subsys_initcall(clk_test_init);