drivers/clk/clk-fixed-factor.c

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