clk/qcom/clk-krait.c

23 static void __krait_mux_set_sel(struct krait_mux_clk *mux, int sel)
30 	regval = krait_get_l2_indirect_reg(mux->offset);
33 	if (mux->disable_sec_src_gating) {
35 		krait_set_l2_indirect_reg(mux->offset, regval);
38 	regval &= ~(mux->mask << mux->shift);
39 	regval |= (sel & mux->mask) << mux->shift;
40 	if (mux->lpl) {
41 		regval &= ~(mux->mask << (mux->shift + LPL_SHIFT));
42 		regval |= (sel & mux->mask) << (mux->shift + LPL_SHIFT);
44 	krait_set_l2_indirect_reg(mux->offset, regval);
47 	if (mux->disable_sec_src_gating) {
49 		krait_set_l2_indirect_reg(mux->offset, regval);
57 	 * Unlock now to make sure the mux register is not
65 	struct krait_mux_clk *mux = to_krait_mux_clk(hw);
68 	sel = clk_mux_index_to_val(mux->parent_map, 0, index);
69 	mux->en_mask = sel;
70 	/* Don't touch mux if CPU is off as it won't work */
72 		__krait_mux_set_sel(mux, sel);
74 	mux->reparent = true;
81 	struct krait_mux_clk *mux = to_krait_mux_clk(hw);
84 	sel = krait_get_l2_indirect_reg(mux->offset);
85 	sel >>= mux->shift;
86 	sel &= mux->mask;
87 	mux->en_mask = sel;
89 	return clk_mux_val_to_index(hw, mux->parent_map, 0, sel);