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 return val; 39 } 40 41 static int mux_set_parent(struct clk_hw *hw, u8 index) 42 { 43 struct clk_regmap_mux *mux = to_clk_regmap_mux(hw); 44 struct clk_regmap *clkr = to_clk_regmap(hw); 45 unsigned int mask = GENMASK(mux->width + mux->shift - 1, mux->shift); 46 unsigned int val; 47 48 val = index; 49 val <<= mux->shift; 50 51 return regmap_update_bits(clkr->regmap, mux->reg, mask, val); 52 } 53 54 const struct clk_ops clk_regmap_mux_closest_ops = { 55 .get_parent = mux_get_parent, 56 .set_parent = mux_set_parent, 57 .determine_rate = __clk_mux_determine_rate_closest, 58 }; 59 EXPORT_SYMBOL_GPL(clk_regmap_mux_closest_ops); 60