From mboxrd@z Thu Jan 1 00:00:00 1970 From: Lukasz Majewski Date: Sun, 8 Dec 2019 15:38:04 +0100 Subject: [PATCH 10/20] clk: imx: pfd: add set_rate() In-Reply-To: <20191204174439.69934-11-giulio.benetti@benettiengineering.com> References: <20191204174439.69934-1-giulio.benetti@benettiengineering.com> <20191204174439.69934-11-giulio.benetti@benettiengineering.com> Message-ID: <20191208153804.40955b7b@jawa> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de On Wed, 4 Dec 2019 18:44:29 +0100 Giulio Benetti wrote: > Implement set_rate() for pfd. > > Signed-off-by: Giulio Benetti > --- > 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 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 at denx.de -------------- next part -------------- A non-text attachment was scrubbed... Name: not available Type: application/pgp-signature Size: 488 bytes Desc: OpenPGP digital signature URL: