diff options
Diffstat (limited to 'kernel/drivers/clk/spear/clk.c')
| -rw-r--r-- | kernel/drivers/clk/spear/clk.c | 39 |
1 files changed, 39 insertions, 0 deletions
diff --git a/kernel/drivers/clk/spear/clk.c b/kernel/drivers/clk/spear/clk.c new file mode 100644 index 000000000..628b6d5ed --- /dev/null +++ b/kernel/drivers/clk/spear/clk.c @@ -0,0 +1,39 @@ +/* + * Copyright (C) 2012 ST Microelectronics + * Viresh Kumar <viresh.linux@gmail.com> + * + * This file is licensed under the terms of the GNU General Public + * License version 2. This program is licensed "as is" without any + * warranty of any kind, whether express or implied. + * + * SPEAr clk - Common routines + */ + +#include <linux/clk-provider.h> +#include <linux/types.h> +#include "clk.h" + +long clk_round_rate_index(struct clk_hw *hw, unsigned long drate, + unsigned long parent_rate, clk_calc_rate calc_rate, u8 rtbl_cnt, + int *index) +{ + unsigned long prev_rate, rate = 0; + + for (*index = 0; *index < rtbl_cnt; (*index)++) { + prev_rate = rate; + rate = calc_rate(hw, parent_rate, *index); + if (drate < rate) { + /* previous clock was best */ + if (*index) { + rate = prev_rate; + (*index)--; + } + break; + } + } + + if ((*index) == rtbl_cnt) + (*index)--; + + return rate; +} |