1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2019 DENX Software Engineering
4 * Lukasz Majewski, DENX Software Engineering, lukma@denx.de
5 *
6 * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
7 */
8 #include <common.h>
9 #include <malloc.h>
10 #include <clk-uclass.h>
11 #include <dm/device.h>
12 #include <dm/devres.h>
13 #include <linux/clk-provider.h>
14 #include <div64.h>
15 #include <clk.h>
16 #include "clk.h"
17 #include <linux/err.h>
18
19 #define UBOOT_DM_CLK_IMX_FIXED_FACTOR "ccf_clk_fixed_factor"
20
clk_factor_recalc_rate(struct clk * clk)21 static ulong clk_factor_recalc_rate(struct clk *clk)
22 {
23 struct clk_fixed_factor *fix = to_clk_fixed_factor(clk);
24 unsigned long parent_rate = clk_get_parent_rate(clk);
25 unsigned long long int rate;
26
27 rate = (unsigned long long int)parent_rate * fix->mult;
28 do_div(rate, fix->div);
29 return (ulong)rate;
30 }
31
32 const struct clk_ops ccf_clk_fixed_factor_ops = {
33 .get_rate = clk_factor_recalc_rate,
34 };
35
clk_hw_register_fixed_factor(struct device * dev,const char * name,const char * parent_name,unsigned long flags,unsigned int mult,unsigned int div)36 struct clk *clk_hw_register_fixed_factor(struct device *dev,
37 const char *name, const char *parent_name, unsigned long flags,
38 unsigned int mult, unsigned int div)
39 {
40 struct clk_fixed_factor *fix;
41 struct clk *clk;
42 int ret;
43
44 fix = kzalloc(sizeof(*fix), GFP_KERNEL);
45 if (!fix)
46 return ERR_PTR(-ENOMEM);
47
48 /* struct clk_fixed_factor assignments */
49 fix->mult = mult;
50 fix->div = div;
51 clk = &fix->clk;
52 clk->flags = flags;
53
54 ret = clk_register(clk, UBOOT_DM_CLK_IMX_FIXED_FACTOR, name,
55 parent_name);
56 if (ret) {
57 kfree(fix);
58 return ERR_PTR(ret);
59 }
60
61 return clk;
62 }
63
clk_register_fixed_factor(struct device * dev,const char * name,const char * parent_name,unsigned long flags,unsigned int mult,unsigned int div)64 struct clk *clk_register_fixed_factor(struct device *dev, const char *name,
65 const char *parent_name, unsigned long flags,
66 unsigned int mult, unsigned int div)
67 {
68 struct clk *clk;
69
70 clk = clk_hw_register_fixed_factor(dev, name, parent_name, flags, mult,
71 div);
72 if (IS_ERR(clk))
73 return ERR_CAST(clk);
74 return clk;
75 }
76
77 U_BOOT_DRIVER(imx_clk_fixed_factor) = {
78 .name = UBOOT_DM_CLK_IMX_FIXED_FACTOR,
79 .id = UCLASS_CLK,
80 .ops = &ccf_clk_fixed_factor_ops,
81 .flags = DM_FLAG_PRE_RELOC,
82 };
83