Pull trivial into test branch
[linux-2.6] / arch / v850 / kernel / v850e_utils.c
1 /*
2  * include/asm-v850/v850e_utils.h -- Utility functions associated with
3  *      V850E CPUs
4  *
5  *  Copyright (C) 2001,02,03  NEC Electronics Corporation
6  *  Copyright (C) 2001,02,03  Miles Bader <miles@gnu.org>
7  *
8  * This file is subject to the terms and conditions of the GNU General
9  * Public License.  See the file COPYING in the main directory of this
10  * archive for more details.
11  *
12  * Written by Miles Bader <miles@gnu.org>
13  */
14
15 #include <asm/v850e_utils.h>
16
17 /* Calculate counter clock-divider and count values to attain the
18    desired frequency RATE from the base frequency BASE_FREQ.  The
19    counter is expected to have a clock-divider, which can divide the
20    system cpu clock by a power of two value from MIN_DIVLOG2 to
21    MAX_DIV_LOG2, and a word-size of COUNTER_SIZE bits (the counter
22    counts up and resets whenever it's equal to the compare register,
23    generating an interrupt or whatever when it does so).  The returned
24    values are: *DIVLOG2 -- log2 of the desired clock divider and *COUNT
25    -- the counter compare value to use.  Returns true if it was possible
26    to find a reasonable value, otherwise false (and the other return
27    values will be set to be as good as possible).  */
28 int calc_counter_params (unsigned long base_freq,
29                          unsigned long rate,
30                          unsigned min_divlog2, unsigned max_divlog2,
31                          unsigned counter_size,
32                          unsigned *divlog2, unsigned *count)
33 {
34         unsigned _divlog2;
35         int ok = 0;
36
37         /* Find the lowest clock divider setting that can represent RATE.  */
38         for (_divlog2 = min_divlog2; _divlog2 <= max_divlog2; _divlog2++) {
39                 /* Minimum interrupt rate possible using this divider.  */
40                 unsigned min_int_rate
41                         = (base_freq >> _divlog2) >> counter_size;
42
43                 if (min_int_rate <= rate) {
44                         /* This setting is the highest resolution
45                            setting that's slow enough enough to attain
46                            RATE interrupts per second, so use it.  */
47                         ok = 1;
48                         break;
49                 }
50         }
51
52         if (_divlog2 > max_divlog2)
53                 /* Can't find correct setting.  */
54                 _divlog2 = max_divlog2;
55
56         if (divlog2)
57                 *divlog2 = _divlog2;
58         if (count)
59                 *count = ((base_freq >> _divlog2) + rate/2) / rate;
60
61         return ok;
62 }