24 static unsigned int _get_maxdiv(struct mmp_clk_mix *mix)  in _get_maxdiv()  argument
26 	unsigned int div_mask = (1 << mix->reg_info.width_div) - 1;  in _get_maxdiv()
30 	if (mix->div_flags & CLK_DIVIDER_ONE_BASED)  in _get_maxdiv()
32 	if (mix->div_flags & CLK_DIVIDER_POWER_OF_TWO)  in _get_maxdiv()
34 	if (mix->div_table) {  in _get_maxdiv()
35 		for (clkt = mix->div_table; clkt->div; clkt++)  in _get_maxdiv()
43 static unsigned int _get_div(struct mmp_clk_mix *mix, unsigned int val)  in _get_div()  argument
47 	if (mix->div_flags & CLK_DIVIDER_ONE_BASED)  in _get_div()
49 	if (mix->div_flags & CLK_DIVIDER_POWER_OF_TWO)  in _get_div()
51 	if (mix->div_table) {  in _get_div()
52 		for (clkt = mix->div_table; clkt->div; clkt++)  in _get_div()
61 static unsigned int _get_mux(struct mmp_clk_mix *mix, unsigned int val)  in _get_mux()  argument
63 	int num_parents = clk_hw_get_num_parents(&mix->hw);  in _get_mux()
66 	if (mix->mux_flags & CLK_MUX_INDEX_BIT)  in _get_mux()
68 	if (mix->mux_flags & CLK_MUX_INDEX_ONE)  in _get_mux()
70 	if (mix->mux_table) {  in _get_mux()
72 			if (mix->mux_table[i] == val)  in _get_mux()
80 static unsigned int _get_div_val(struct mmp_clk_mix *mix, unsigned int div)  in _get_div_val()  argument
84 	if (mix->div_flags & CLK_DIVIDER_ONE_BASED)  in _get_div_val()
86 	if (mix->div_flags & CLK_DIVIDER_POWER_OF_TWO)  in _get_div_val()
88 	if (mix->div_table) {  in _get_div_val()
89 		for (clkt = mix->div_table; clkt->div; clkt++)  in _get_div_val()
99 static unsigned int _get_mux_val(struct mmp_clk_mix *mix, unsigned int mux)  in _get_mux_val()  argument
101 	if (mix->mux_table)  in _get_mux_val()
102 		return mix->mux_table[mux];  in _get_mux_val()
107 static void _filter_clk_table(struct mmp_clk_mix *mix,  in _filter_clk_table()  argument
116 	hw = &mix->hw;  in _filter_clk_table()
131 static int _set_rate(struct mmp_clk_mix *mix, u32 mux_val, u32 div_val,  in _set_rate()  argument
134 	struct mmp_clk_mix_reg_info *ri = &mix->reg_info;  in _set_rate()
143 	if (mix->lock)  in _set_rate()
144 		spin_lock_irqsave(mix->lock, flags);  in _set_rate()
146 	if (mix->type == MMP_CLK_MIX_TYPE_V1  in _set_rate()
147 		|| mix->type == MMP_CLK_MIX_TYPE_V2)  in _set_rate()
166 	if (mix->type == MMP_CLK_MIX_TYPE_V1) {  in _set_rate()
168 	} else if (mix->type == MMP_CLK_MIX_TYPE_V2) {  in _set_rate()
181 				__func__, clk_hw_get_name(&mix->hw));  in _set_rate()
195 	if (mix->lock)  in _set_rate()
196 		spin_unlock_irqrestore(mix->lock, flags);  in _set_rate()
204 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_mix_determine_rate()  local
219 	if (mix->table) {  in mmp_clk_mix_determine_rate()
220 		for (i = 0; i < mix->table_size; i++) {  in mmp_clk_mix_determine_rate()
221 			item = &mix->table[i];  in mmp_clk_mix_determine_rate()
242 			div_val_max = _get_maxdiv(mix);  in mmp_clk_mix_determine_rate()
244 				div = _get_div(mix, j);  in mmp_clk_mix_determine_rate()
275 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_mix_set_rate_and_parent()  local
280 	div_val = _get_div_val(mix, div);  in mmp_clk_mix_set_rate_and_parent()
281 	mux_val = _get_mux_val(mix, index);  in mmp_clk_mix_set_rate_and_parent()
283 	return _set_rate(mix, mux_val, div_val, 1, 1);  in mmp_clk_mix_set_rate_and_parent()
288 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_mix_get_parent()  local
289 	struct mmp_clk_mix_reg_info *ri = &mix->reg_info;  in mmp_clk_mix_get_parent()
295 	if (mix->lock)  in mmp_clk_mix_get_parent()
296 		spin_lock_irqsave(mix->lock, flags);  in mmp_clk_mix_get_parent()
298 	if (mix->type == MMP_CLK_MIX_TYPE_V1  in mmp_clk_mix_get_parent()
299 		|| mix->type == MMP_CLK_MIX_TYPE_V2)  in mmp_clk_mix_get_parent()
304 	if (mix->lock)  in mmp_clk_mix_get_parent()
305 		spin_unlock_irqrestore(mix->lock, flags);  in mmp_clk_mix_get_parent()
307 	width = mix->reg_info.width_mux;  in mmp_clk_mix_get_parent()
308 	shift = mix->reg_info.shift_mux;  in mmp_clk_mix_get_parent()
312 	return _get_mux(mix, mux_val);  in mmp_clk_mix_get_parent()
318 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_mix_recalc_rate()  local
319 	struct mmp_clk_mix_reg_info *ri = &mix->reg_info;  in mmp_clk_mix_recalc_rate()
325 	if (mix->lock)  in mmp_clk_mix_recalc_rate()
326 		spin_lock_irqsave(mix->lock, flags);  in mmp_clk_mix_recalc_rate()
328 	if (mix->type == MMP_CLK_MIX_TYPE_V1  in mmp_clk_mix_recalc_rate()
329 		|| mix->type == MMP_CLK_MIX_TYPE_V2)  in mmp_clk_mix_recalc_rate()
334 	if (mix->lock)  in mmp_clk_mix_recalc_rate()
335 		spin_unlock_irqrestore(mix->lock, flags);  in mmp_clk_mix_recalc_rate()
337 	width = mix->reg_info.width_div;  in mmp_clk_mix_recalc_rate()
338 	shift = mix->reg_info.shift_div;  in mmp_clk_mix_recalc_rate()
340 	div = _get_div(mix, MMP_CLK_BITS_GET_VAL(mux_div, width, shift));  in mmp_clk_mix_recalc_rate()
347 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_set_parent()  local
352 	if (mix->table) {  in mmp_clk_set_parent()
353 		for (i = 0; i < mix->table_size; i++) {  in mmp_clk_set_parent()
354 			item = &mix->table[i];  in mmp_clk_set_parent()
360 		if (i < mix->table_size) {  in mmp_clk_set_parent()
361 			div_val = _get_div_val(mix, item->divisor);  in mmp_clk_set_parent()
362 			mux_val = _get_mux_val(mix, item->parent_index);  in mmp_clk_set_parent()
366 		mux_val = _get_mux_val(mix, index);  in mmp_clk_set_parent()
370 	return _set_rate(mix, mux_val, div_val, 1, div_val ? 1 : 0);  in mmp_clk_set_parent()
376 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_set_rate()  local
385 	if (mix->table) {  in mmp_clk_set_rate()
386 		for (i = 0; i < mix->table_size; i++) {  in mmp_clk_set_rate()
387 			item = &mix->table[i];  in mmp_clk_set_rate()
397 		if (i < mix->table_size)  in mmp_clk_set_rate()
398 			return _set_rate(mix,  in mmp_clk_set_rate()
399 					_get_mux_val(mix, item->parent_index),  in mmp_clk_set_rate()
400 					_get_div_val(mix, item->divisor),  in mmp_clk_set_rate()
412 			return _set_rate(mix, _get_mux_val(mix, i),  in mmp_clk_set_rate()
413 					_get_div_val(mix, best_divisor), 1, 1);  in mmp_clk_set_rate()
421 	struct mmp_clk_mix *mix = to_clk_mix(hw);  in mmp_clk_mix_init()  local
423 	if (mix->table)  in mmp_clk_mix_init()
424 		_filter_clk_table(mix, mix->table, mix->table_size);  in mmp_clk_mix_init()
447 	struct mmp_clk_mix *mix;  in mmp_clk_register_mix()  local
452 	mix = kzalloc(sizeof(*mix), GFP_KERNEL);  in mmp_clk_register_mix()
453 	if (!mix)  in mmp_clk_register_mix()
462 	memcpy(&mix->reg_info, &config->reg_info, sizeof(config->reg_info));  in mmp_clk_register_mix()
465 		mix->table = kmemdup(config->table, table_bytes, GFP_KERNEL);  in mmp_clk_register_mix()
466 		if (!mix->table)  in mmp_clk_register_mix()
469 		mix->table_size = config->table_size;  in mmp_clk_register_mix()
474 		mix->mux_table = kmemdup(config->mux_table, table_bytes,  in mmp_clk_register_mix()
476 		if (!mix->mux_table) {  in mmp_clk_register_mix()
477 			kfree(mix->table);  in mmp_clk_register_mix()
482 	mix->div_flags = config->div_flags;  in mmp_clk_register_mix()
483 	mix->mux_flags = config->mux_flags;  in mmp_clk_register_mix()
484 	mix->lock = lock;  in mmp_clk_register_mix()
485 	mix->hw.init = &init;  in mmp_clk_register_mix()
488 		mix->type = MMP_CLK_MIX_TYPE_V1;  in mmp_clk_register_mix()
490 		mix->type = MMP_CLK_MIX_TYPE_V3;  in mmp_clk_register_mix()
492 		mix->type = MMP_CLK_MIX_TYPE_V2;  in mmp_clk_register_mix()
493 	clk = clk_register(dev, &mix->hw);  in mmp_clk_register_mix()
496 		kfree(mix->mux_table);  in mmp_clk_register_mix()
497 		kfree(mix->table);  in mmp_clk_register_mix()
498 		kfree(mix);  in mmp_clk_register_mix()
504 	kfree(mix);  in mmp_clk_register_mix()