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);
63