58 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*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 13static 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 18static 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_cfg_index(hw, mux->parent_map, val);32 33 return val;34}35 36static 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 52const 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};57EXPORT_SYMBOL_GPL(clk_regmap_mux_closest_ops);58