1 /* 2 * Copyright (c) 2014, The Linux Foundation. All rights reserved. 3 * 4 * This software is licensed under the terms of the GNU General Public 5 * License version 2, as published by the Free Software Foundation, and 6 * may be copied, distributed, and modified under those terms. 7 * 8 * This program is distributed in the hope that it will be useful, 9 * but WITHOUT ANY WARRANTY; without even the implied warranty of 10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 11 * GNU General Public License for more details. 12 */ 13 14 #include <linux/kernel.h> 15 #include <linux/bitops.h> 16 #include <linux/regmap.h> 17 #include <linux/export.h> 18 19 #include "clk-regmap-mux.h" 20 21 static inline struct clk_regmap_mux *to_clk_regmap_mux(struct clk_hw *hw) 22 { 23 return container_of(to_clk_regmap(hw), struct clk_regmap_mux, clkr); 24 } 25 26 static u8 mux_get_parent(struct clk_hw *hw) 27 { 28 struct clk_regmap_mux *mux = to_clk_regmap_mux(hw); 29 struct clk_regmap *clkr = to_clk_regmap(hw); 30 unsigned int mask = GENMASK(mux->width - 1, 0); 31 unsigned int val; 32 33 regmap_read(clkr->regmap, mux->reg, &val); 34 35 val >>= mux->shift; 36 val &= mask; 37 38 if (mux->parent_map) 39 return qcom_find_src_index(hw, mux->parent_map, val); 40 41 return val; 42 } 43 44 static int mux_set_parent(struct clk_hw *hw, u8 index) 45 { 46 struct clk_regmap_mux *mux = to_clk_regmap_mux(hw); 47 struct clk_regmap *clkr = to_clk_regmap(hw); 48 unsigned int mask = GENMASK(mux->width + mux->shift - 1, mux->shift); 49 unsigned int val; 50 51 if (mux->parent_map) 52 index = mux->parent_map[index].cfg; 53 54 val = index; 55 val <<= mux->shift; 56 57 return regmap_update_bits(clkr->regmap, mux->reg, mask, val); 58 } 59 60 const struct clk_ops clk_regmap_mux_closest_ops = { 61 .get_parent = mux_get_parent, 62 .set_parent = mux_set_parent, 63 .determine_rate = __clk_mux_determine_rate_closest, 64 }; 65 EXPORT_SYMBOL_GPL(clk_regmap_mux_closest_ops); 66