diff options
author | Giulio Benetti <giulio.benetti@benettiengineering.com> | 2020-01-10 17:47:00 +0300 |
---|---|---|
committer | Stefano Babic <sbabic@denx.de> | 2020-01-15 00:53:59 +0300 |
commit | 824c371f9bed266ccf4b8b4d8b37d8f3f9813375 (patch) | |
tree | b5ce46ec7befe55aafb7dfe75e32581f73ef5029 /drivers/clk/imx/clk-pfd.c | |
parent | efadf790f3e34488a2f43b6453d4df947e5a738d (diff) | |
download | u-boot-824c371f9bed266ccf4b8b4d8b37d8f3f9813375.tar.xz |
clk: imx: pfd: add set_rate()
Implement set_rate() for pfd.
Signed-off-by: Giulio Benetti <giulio.benetti@benettiengineering.com>
Reviewed-by: Lukasz Majewski <lukma@denx.de>
Diffstat (limited to 'drivers/clk/imx/clk-pfd.c')
-rw-r--r-- | drivers/clk/imx/clk-pfd.c | 22 |
1 files changed, 22 insertions, 0 deletions
diff --git a/drivers/clk/imx/clk-pfd.c b/drivers/clk/imx/clk-pfd.c index 188b2b3b90..4ae55f5a07 100644 --- a/drivers/clk/imx/clk-pfd.c +++ b/drivers/clk/imx/clk-pfd.c @@ -52,8 +52,30 @@ static unsigned long clk_pfd_recalc_rate(struct clk *clk) return tmp; } +static unsigned long clk_pfd_set_rate(struct clk *clk, unsigned long rate) +{ + struct clk_pfd *pfd = to_clk_pfd(clk); + unsigned long parent_rate = clk_get_parent_rate(clk); + u64 tmp = parent_rate; + u8 frac; + + tmp = tmp * 18 + rate / 2; + do_div(tmp, rate); + frac = tmp; + if (frac < 12) + frac = 12; + else if (frac > 35) + frac = 35; + + writel(0x3f << (pfd->idx * 8), pfd->reg + CLR); + writel(frac << (pfd->idx * 8), pfd->reg + SET); + + return 0; +} + static const struct clk_ops clk_pfd_ops = { .get_rate = clk_pfd_recalc_rate, + .set_rate = clk_pfd_set_rate, }; struct clk *imx_clk_pfd(const char *name, const char *parent_name, |