On Wed, 4 Dec 2019 18:44:29 +0100 Giulio Benetti giulio.benetti@benettiengineering.com wrote:
Implement set_rate() for pfd.
Signed-off-by: Giulio Benetti giulio.benetti@benettiengineering.com
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,
Reviewed-by: Lukasz Majewski lukma@denx.de
Best regards,
Lukasz Majewski
--
DENX Software Engineering GmbH, Managing Director: Wolfgang Denk HRB 165235 Munich, Office: Kirchenstr.5, D-82194 Groebenzell, Germany Phone: (+49)-8142-66989-59 Fax: (+49)-8142-66989-80 Email: lukma@denx.de