Merge "clk: qcom: Update ops for esc clock source" (081dc50e) · Commits · e / devices / android_kernel_sony_msm8998

drivers/clk/qcom/clk-rcg.h

+2 −1

Original line number	Diff line number	Diff line
		/*
		* Copyright (c) 2013, 2016, The Linux Foundation. All rights reserved.
		* Copyright (c) 2013, 2016-2017, The Linux Foundation. All rights reserved.
		*
		* This software is licensed under the terms of the GNU General Public
		* License version 2, as published by the Free Software Foundation, and
		@@ -192,5 +192,6 @@ extern const struct clk_ops clk_pixel_ops;
		extern const struct clk_ops clk_gfx3d_ops;
		extern const struct clk_ops clk_gfx3d_src_ops;
		extern const struct clk_ops clk_dp_ops;
		extern const struct clk_ops clk_esc_ops;

		#endif

drivers/clk/qcom/clk-rcg2.c

+70 −0

Original line number	Diff line number	Diff line
		@@ -1349,3 +1349,73 @@ const struct clk_ops clk_gfx3d_src_ops = {
		.list_registers = clk_rcg2_list_registers,
		};
		EXPORT_SYMBOL_GPL(clk_gfx3d_src_ops);

		static int clk_esc_determine_rate(struct clk_hw *hw,
		struct clk_rate_request *req)
		{
		struct clk_rcg2 *rcg = to_clk_rcg2(hw);
		unsigned long parent_rate, div;
		u32 mask = BIT(rcg->hid_width) - 1;
		struct clk_hw *p;
		unsigned long rate = req->rate;

		if (rate == 0)
		return -EINVAL;

		p = req->best_parent_hw;
		req->best_parent_rate = parent_rate = clk_hw_round_rate(p, rate);

		div = ((2 * parent_rate) / rate) - 1;
		div = min_t(u32, div, mask);

		req->rate = calc_rate(parent_rate, 0, 0, 0, div);

		return 0;
		}

		static int clk_esc_set_rate(struct clk_hw *hw, unsigned long rate,
		unsigned long parent_rate)
		{
		struct clk_rcg2 *rcg = to_clk_rcg2(hw);
		struct freq_tbl f = { 0 };
		unsigned long div;
		int i, num_parents = clk_hw_get_num_parents(hw);
		u32 mask = BIT(rcg->hid_width) - 1;
		u32 cfg;

		div = ((2 * parent_rate) / rate) - 1;
		div = min_t(u32, div, mask);

		f.pre_div = div;

		regmap_read(rcg->clkr.regmap, rcg->cmd_rcgr + CFG_REG, &cfg);
		cfg &= CFG_SRC_SEL_MASK;
		cfg >>= CFG_SRC_SEL_SHIFT;

		for (i = 0; i < num_parents; i++) {
		if (cfg == rcg->parent_map[i].cfg) {
		f.src = rcg->parent_map[i].src;
		return clk_rcg2_configure(rcg, &f);
		}
		}

		return -EINVAL;
		}

		static int clk_esc_set_rate_and_parent(struct clk_hw *hw,
		unsigned long rate, unsigned long parent_rate, u8 index)
		{
		return clk_esc_set_rate(hw, rate, parent_rate);
		}

		const struct clk_ops clk_esc_ops = {
		.is_enabled = clk_rcg2_is_enabled,
		.get_parent = clk_rcg2_get_parent,
		.set_parent = clk_rcg2_set_parent,
		.recalc_rate = clk_rcg2_recalc_rate,
		.determine_rate = clk_esc_determine_rate,
		.set_rate = clk_esc_set_rate,
		.set_rate_and_parent = clk_esc_set_rate_and_parent,
		.list_registers = clk_rcg2_list_registers,
		};
		EXPORT_SYMBOL(clk_esc_ops);

drivers/clk/qcom/mmcc-sdm660.c

+2 −4

Original line number	Diff line number	Diff line
		@@ -978,12 +978,11 @@ static struct clk_rcg2 esc0_clk_src = {
		.mnd_width = 0,
		.hid_width = 5,
		.parent_map = mmcc_parent_map_1,
		.freq_tbl = ftbl_dp_aux_clk_src,
		.clkr.hw.init = &(struct clk_init_data){
		.name = "esc0_clk_src",
		.parent_names = mmcc_parent_names_1,
		.num_parents = 4,
		.ops = &clk_rcg2_ops,
		.ops = &clk_esc_ops,
		VDD_DIG_FMAX_MAP1(
		LOWER, 19200000),
		},
		@@ -994,12 +993,11 @@ static struct clk_rcg2 esc1_clk_src = {
		.mnd_width = 0,
		.hid_width = 5,
		.parent_map = mmcc_parent_map_1,
		.freq_tbl = ftbl_dp_aux_clk_src,
		.clkr.hw.init = &(struct clk_init_data){
		.name = "esc1_clk_src",
		.parent_names = mmcc_parent_names_1,
		.num_parents = 4,
		.ops = &clk_rcg2_ops,
		.ops = &clk_esc_ops,
		VDD_DIG_FMAX_MAP1(
		LOWER, 19200000),
		},