clk-regmap-phy-mux.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2022, Linaro Ltd.
   4  */
   5
   6 #include <linux/clk-provider.h>
   7 #include <linux/bitfield.h>
   8 #include <linux/regmap.h>
   9 #include <linux/export.h>
  10
  11 #include "clk-regmap.h"
  12 #include "clk-regmap-phy-mux.h"
  13
  14 #define PHY_MUX_MASK            GENMASK(1, 0)
  15 #define PHY_MUX_PHY_SRC         0
  16 #define PHY_MUX_REF_SRC         2
  17
  18 static inline struct clk_regmap_phy_mux *to_clk_regmap_phy_mux(struct clk_regmap *clkr)
  19 {
  20         return container_of(clkr, struct clk_regmap_phy_mux, clkr);
  21 }
  22
  23 static int phy_mux_is_enabled(struct clk_hw *hw)
  24 {
  25         struct clk_regmap *clkr = to_clk_regmap(hw);
  26         struct clk_regmap_phy_mux *phy_mux = to_clk_regmap_phy_mux(clkr);
  27         unsigned int val;
  28
  29         regmap_read(clkr->regmap, phy_mux->reg, &val);
  30         val = FIELD_GET(PHY_MUX_MASK, val);
  31
  32         WARN_ON(val != PHY_MUX_PHY_SRC && val != PHY_MUX_REF_SRC);
  33
  34         return val == PHY_MUX_PHY_SRC;
  35 }
  36
  37 static int phy_mux_enable(struct clk_hw *hw)
  38 {
  39         struct clk_regmap *clkr = to_clk_regmap(hw);
  40         struct clk_regmap_phy_mux *phy_mux = to_clk_regmap_phy_mux(clkr);
  41
  42         return regmap_update_bits(clkr->regmap, phy_mux->reg,
  43                                   PHY_MUX_MASK,
  44                                   FIELD_PREP(PHY_MUX_MASK, PHY_MUX_PHY_SRC));
  45 }
  46
  47 static void phy_mux_disable(struct clk_hw *hw)
  48 {
  49         struct clk_regmap *clkr = to_clk_regmap(hw);
  50         struct clk_regmap_phy_mux *phy_mux = to_clk_regmap_phy_mux(clkr);
  51
  52         regmap_update_bits(clkr->regmap, phy_mux->reg,
  53                            PHY_MUX_MASK,
  54                            FIELD_PREP(PHY_MUX_MASK, PHY_MUX_REF_SRC));
  55 }
  56
  57 const struct clk_ops clk_regmap_phy_mux_ops = {
  58         .enable = phy_mux_enable,
  59         .disable = phy_mux_disable,
  60         .is_enabled = phy_mux_is_enabled,
  61 };
  62 EXPORT_SYMBOL_GPL(clk_regmap_phy_mux_ops);