57 static inline u64 scaled_div_value(struct bcm_clk_div *div, u32 reg_div)  in scaled_div_value()  argument
59 	return (u64)reg_div + ((u64)1 << div->u.s.frac_width);  in scaled_div_value()
67 u64 scaled_div_build(struct bcm_clk_div *div, u32 div_value, u32 billionths)  in scaled_div_build()  argument
75 	combined <<= div->u.s.frac_width;  in scaled_div_build()
82 scaled_div_min(struct bcm_clk_div *div)  in scaled_div_min()  argument
84 	if (divider_is_fixed(div))  in scaled_div_min()
85 		return (u64)div->u.fixed;  in scaled_div_min()
87 	return scaled_div_value(div, 0);  in scaled_div_min()
91 u64 scaled_div_max(struct bcm_clk_div *div)  in scaled_div_max()  argument
95 	if (divider_is_fixed(div))  in scaled_div_max()
96 		return (u64)div->u.fixed;  in scaled_div_max()
98 	reg_div = ((u32)1 << div->u.s.width) - 1;  in scaled_div_max()
100 	return scaled_div_value(div, reg_div);  in scaled_div_max()
108 divider(struct bcm_clk_div *div, u64 scaled_div)  in divider()  argument
110 	BUG_ON(scaled_div < scaled_div_min(div));  in divider()
111 	BUG_ON(scaled_div > scaled_div_max(div));  in divider()
113 	return (u32)(scaled_div - ((u64)1 << div->u.s.frac_width));  in divider()
118 scale_rate(struct bcm_clk_div *div, u32 rate)  in scale_rate()  argument
120 	if (divider_is_fixed(div))  in scale_rate()
123 	return (u64)rate << div->u.s.frac_width;  in scale_rate()
563 static u64 divider_read_scaled(struct ccu_data *ccu, struct bcm_clk_div *div)  in divider_read_scaled()  argument
569 	if (divider_is_fixed(div))  in divider_read_scaled()
570 		return (u64)div->u.fixed;  in divider_read_scaled()
573 	reg_val = __ccu_read(ccu, div->u.s.offset);  in divider_read_scaled()
577 	reg_div = bitfield_extract(reg_val, div->u.s.shift, div->u.s.width);  in divider_read_scaled()
580 	return scaled_div_value(div, reg_div);  in divider_read_scaled()
591 			struct bcm_clk_div *div, struct bcm_clk_trig *trig)  in __div_commit()  argument
598 	BUG_ON(divider_is_fixed(div));  in __div_commit()
605 	if (div->u.s.scaled_div == BAD_SCALED_DIV_VALUE) {  in __div_commit()
606 		reg_val = __ccu_read(ccu, div->u.s.offset);  in __div_commit()
607 		reg_div = bitfield_extract(reg_val, div->u.s.shift,  in __div_commit()
608 						div->u.s.width);  in __div_commit()
609 		div->u.s.scaled_div = scaled_div_value(div, reg_div);  in __div_commit()
615 	reg_div = divider(div, div->u.s.scaled_div);  in __div_commit()
625 	reg_val = __ccu_read(ccu, div->u.s.offset);  in __div_commit()
626 	reg_val = bitfield_replace(reg_val, div->u.s.shift, div->u.s.width,  in __div_commit()
628 	__ccu_write(ccu, div->u.s.offset, reg_val);  in __div_commit()
647 			struct bcm_clk_div *div, struct bcm_clk_trig *trig)  in div_init()  argument
649 	if (!divider_exists(div) || divider_is_fixed(div))  in div_init()
651 	return !__div_commit(ccu, gate, div, trig);  in div_init()
655 			struct bcm_clk_div *div, struct bcm_clk_trig *trig,  in divider_write()  argument
662 	BUG_ON(divider_is_fixed(div));  in divider_write()
664 	previous = div->u.s.scaled_div;  in divider_write()
668 	div->u.s.scaled_div = scaled_div;  in divider_write()
673 	ret = __div_commit(ccu, gate, div, trig);  in divider_write()
679 		div->u.s.scaled_div = previous;		/* Revert the change */  in divider_write()
693 			struct bcm_clk_div *div, struct bcm_clk_div *pre_div,  in clk_recalc_rate()  argument
700 	if (!divider_exists(div))  in clk_recalc_rate()
719 		scaled_rate = scale_rate(div, scaled_rate);  in clk_recalc_rate()
724 		scaled_parent_rate = scale_rate(div, parent_rate);  in clk_recalc_rate()
732 	scaled_div = divider_read_scaled(ccu, div);  in clk_recalc_rate()
747 static long round_rate(struct ccu_data *ccu, struct bcm_clk_div *div,  in round_rate()  argument
758 	BUG_ON(!divider_exists(div));  in round_rate()
778 		scaled_rate = scale_rate(div, scaled_rate);  in round_rate()
783 		scaled_parent_rate = scale_rate(div, parent_rate);  in round_rate()
791 	if (!divider_is_fixed(div)) {  in round_rate()
794 		min_scaled_div = scaled_div_min(div);  in round_rate()
795 		max_scaled_div = scaled_div_max(div);  in round_rate()
801 		best_scaled_div = divider_read_scaled(ccu, div);  in round_rate()
1003 	return clk_recalc_rate(bcm_clk->ccu, &data->div, &data->pre_div,  in kona_peri_clk_recalc_rate()
1011 	struct bcm_clk_div *div = &bcm_clk->u.peri->div;  in kona_peri_clk_round_rate()  local
1013 	if (!divider_exists(div))  in kona_peri_clk_round_rate()
1017 	return round_rate(bcm_clk->ccu, div, &bcm_clk->u.peri->pre_div,  in kona_peri_clk_round_rate()
1134 	struct bcm_clk_div *div = &data->div;  in kona_peri_clk_set_rate()  local
1144 	if (!divider_exists(div))  in kona_peri_clk_set_rate()
1152 	if (divider_is_fixed(&data->div))  in kona_peri_clk_set_rate()
1160 	(void)round_rate(bcm_clk->ccu, div, &data->pre_div,  in kona_peri_clk_set_rate()
1167 	ret = divider_write(bcm_clk->ccu, &data->gate, &data->div,  in kona_peri_clk_set_rate()
1215 	if (!div_init(ccu, &peri->gate, &peri->div, &peri->trig)) {  in __peri_clk_init()