1// SPDX-License-Identifier: GPL-2.0-only
2/*
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