drivers/clk/qcom/clk-regmap-mux.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-mux.h"
  12
  13 static inline struct clk_regmap_mux *to_clk_regmap_mux(struct clk_hw *hw)
  14 {
  15         return container_of(to_clk_regmap(hw), struct clk_regmap_mux, clkr);
  16 }
  17
  18 static u8 mux_get_parent(struct clk_hw *hw)
  19 {
  20         struct clk_regmap_mux *mux = to_clk_regmap_mux(hw);
  21         struct clk_regmap *clkr = to_clk_regmap(hw);
  22         unsigned int mask = GENMASK(mux->width - 1, 0);
  23         unsigned int val;
  24
  25         regmap_read(clkr->regmap, mux->reg, &val);
  26
  27         val >>= mux->shift;
  28         val &= mask;
  29
  30         if (mux->parent_map)
  31                 return qcom_find_src_index(hw, mux->parent_map, val);
  32
  33         return val;
  34 }
  35
  36 static int mux_set_parent(struct clk_hw *hw, u8 index)
  37 {
  38         struct clk_regmap_mux *mux = to_clk_regmap_mux(hw);
  39         struct clk_regmap *clkr = to_clk_regmap(hw);
  40         unsigned int mask = GENMASK(mux->width + mux->shift - 1, mux->shift);
  41         unsigned int val;
  42
  43         if (mux->parent_map)
  44                 index = mux->parent_map[index].cfg;
  45
  46         val = index;
  47         val <<= mux->shift;
  48
  49         return regmap_update_bits(clkr->regmap, mux->reg, mask, val);
  50 }
  51
  52 const struct clk_ops clk_regmap_mux_closest_ops = {
  53         .get_parent = mux_get_parent,
  54         .set_parent = mux_set_parent,
  55         .determine_rate = __clk_mux_determine_rate_closest,
  56 };
  57 EXPORT_SYMBOL_GPL(clk_regmap_mux_closest_ops);