drivers/clk/qcom/clk-regmap-divider.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2014, The Linux Foundation. All rights reserved.
   4  */
   5
   6 #include <linux/kernel.h>
   7 #include <linux/bitops.h>
   8 #include <linux/regmap.h>
   9 #include <linux/export.h>
  10
  11 #include "clk-regmap-divider.h"
  12
  13 static inline struct clk_regmap_div *to_clk_regmap_div(struct clk_hw *hw)
  14 {
  15         return container_of(to_clk_regmap(hw), struct clk_regmap_div, clkr);
  16 }
  17
  18 static long div_round_ro_rate(struct clk_hw *hw, unsigned long rate,
  19                               unsigned long *prate)
  20 {
  21         struct clk_regmap_div *divider = to_clk_regmap_div(hw);
  22         struct clk_regmap *clkr = &divider->clkr;
  23         u32 val;
  24
  25         regmap_read(clkr->regmap, divider->reg, &val);
  26         val >>= divider->shift;
  27         val &= BIT(divider->width) - 1;
  28
  29         return divider_ro_round_rate(hw, rate, prate, NULL, divider->width,
  30                                      CLK_DIVIDER_ROUND_CLOSEST, val);
  31 }
  32
  33 static long div_round_rate(struct clk_hw *hw, unsigned long rate,
  34                            unsigned long *prate)
  35 {
  36         struct clk_regmap_div *divider = to_clk_regmap_div(hw);
  37
  38         return divider_round_rate(hw, rate, prate, NULL, divider->width,
  39                                   CLK_DIVIDER_ROUND_CLOSEST);
  40 }
  41
  42 static int div_set_rate(struct clk_hw *hw, unsigned long rate,
  43                         unsigned long parent_rate)
  44 {
  45         struct clk_regmap_div *divider = to_clk_regmap_div(hw);
  46         struct clk_regmap *clkr = &divider->clkr;
  47         u32 div;
  48
  49         div = divider_get_val(rate, parent_rate, NULL, divider->width,
  50                               CLK_DIVIDER_ROUND_CLOSEST);
  51
  52         return regmap_update_bits(clkr->regmap, divider->reg,
  53                                   (BIT(divider->width) - 1) << divider->shift,
  54                                   div << divider->shift);
  55 }
  56
  57 static unsigned long div_recalc_rate(struct clk_hw *hw,
  58                                      unsigned long parent_rate)
  59 {
  60         struct clk_regmap_div *divider = to_clk_regmap_div(hw);
  61         struct clk_regmap *clkr = &divider->clkr;
  62         u32 div;
  63
  64         regmap_read(clkr->regmap, divider->reg, &div);
  65         div >>= divider->shift;
  66         div &= BIT(divider->width) - 1;
  67
  68         return divider_recalc_rate(hw, parent_rate, div, NULL,
  69                                    CLK_DIVIDER_ROUND_CLOSEST, divider->width);
  70 }
  71
  72 const struct clk_ops clk_regmap_div_ops = {
  73         .round_rate = div_round_rate,
  74         .set_rate = div_set_rate,
  75         .recalc_rate = div_recalc_rate,
  76 };
  77 EXPORT_SYMBOL_GPL(clk_regmap_div_ops);
  78
  79 const struct clk_ops clk_regmap_div_ro_ops = {
  80         .round_rate = div_round_ro_rate,
  81         .recalc_rate = div_recalc_rate,
  82 };
  83 EXPORT_SYMBOL_GPL(clk_regmap_div_ro_ops);