[PATCH v2 10/21] clk: imx: pfd: add set_rate()

[sbabic]

> Implement set_rate() for pfd.
> Signed-off-by: Giulio Benetti 
> Reviewed-by: Lukasz Majewski 
Applied to u-boot-imx, master, thanks !

Best regards,
Stefano Babic

-- 
=
DENX Software Engineering GmbH,  Managing Director: Wolfgang Denk
HRB 165235 Munich, Office: Kirchenstr.5, D-82194 Groebenzell, Germany
Phone: +49-8142-66989-53 Fax: +49-8142-66989-80 Email: sba...@denx.de
=

[PATCH v2 10/21] clk: imx: pfd: add set_rate()

[Giulio Benetti]

Implement set_rate() for pfd.

Signed-off-by: Giulio Benetti 
Reviewed-by: Lukasz Majewski 
---
 drivers/clk/imx/clk-pfd.c | 22 ++
 1 file changed, 22 insertions(+)

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,
-- 
2.20.1