Lines Matching +full:combined +full:- +full:power +full:- +full:req
15 #include "clk-kona.h"
24 * "Normal", and "Turbo".) A lower policy number has lower power
34 /* Produces a mask of set bits covering a range of a 32-bit value */
37 return ((1 << width) - 1) << shift; in bitfield_mask()
59 return (u64)reg_div + ((u64)1 << div->u.s.frac_width); in scaled_div_value()
69 u64 combined; in scaled_div_build() local
74 combined = (u64)div_value * BILLION + billionths; in scaled_div_build()
75 combined <<= div->u.s.frac_width; in scaled_div_build()
77 return DIV_ROUND_CLOSEST_ULL(combined, BILLION); in scaled_div_build()
85 return (u64)div->u.fixed; in scaled_div_min()
96 return (u64)div->u.fixed; in scaled_div_max()
98 reg_div = ((u32)1 << div->u.s.width) - 1; in scaled_div_max()
113 return (u32)(scaled_div - ((u64)1 << div->u.s.frac_width)); in divider()
123 return (u64)rate << div->u.s.frac_width; in scale_rate()
128 /* Read a 32-bit register value from a CCU's address space. */
131 return readl(ccu->base + reg_offset); in __ccu_read()
134 /* Write a 32-bit register value into a CCU's address space. */
138 writel(reg_val, ccu->base + reg_offset); in __ccu_write()
145 spin_lock_irqsave(&ccu->lock, flags); in ccu_lock()
151 spin_unlock_irqrestore(&ccu->lock, flags); in ccu_unlock()
160 if (ccu->write_enabled) { in __ccu_write_enable()
162 ccu->name); in __ccu_write_enable()
165 ccu->write_enabled = true; in __ccu_write_enable()
171 if (!ccu->write_enabled) { in __ccu_write_disable()
173 ccu->name); in __ccu_write_disable()
178 ccu->write_enabled = false; in __ccu_write_disable()
206 ccu->name, reg_offset, bit, want ? "set" : "clear"); in __ccu_wait_bit()
215 struct bcm_policy_ctl *control = &ccu->policy.control; in __ccu_policy_engine_start()
225 offset = control->offset; in __ccu_policy_engine_start()
226 go_bit = control->go_bit; in __ccu_policy_engine_start()
232 __func__, ccu->name); in __ccu_policy_engine_start()
246 * (ATL bit clear) and setting the request auto-copy (AC bit in __ccu_policy_engine_start()
249 * Note, we do NOT read-modify-write this register. in __ccu_policy_engine_start()
253 mask |= 1 << control->atl_bit; in __ccu_policy_engine_start()
255 mask |= 1 << control->ac_bit; in __ccu_policy_engine_start()
262 __func__, ccu->name); in __ccu_policy_engine_start()
269 struct bcm_lvm_en *enable = &ccu->policy.enable; in __ccu_policy_engine_stop()
279 offset = enable->offset; in __ccu_policy_engine_stop()
280 enable_bit = enable->bit; in __ccu_policy_engine_stop()
284 __func__, ccu->name); in __ccu_policy_engine_stop()
288 /* Now set the bit to stop the engine (NO read-modify-write) */ in __ccu_policy_engine_stop()
295 __func__, ccu->name); in __ccu_policy_engine_stop()
306 * four registers, and the 32-bit registers are at consecutive
325 __func__, ccu->name); in policy_init()
333 offset = policy->offset; in policy_init()
334 mask = (u32)1 << policy->bit; in policy_init()
348 __func__, ccu->name); in policy_init()
366 bit_mask = 1 << gate->status_bit; in __is_clk_gate_enabled()
367 reg_val = __ccu_read(ccu, gate->offset); in __is_clk_gate_enabled()
405 reg_val = __ccu_read(ccu, gate->offset); in __gate_commit()
409 mask = (u32)1 << gate->hw_sw_sel_bit; in __gate_commit()
423 mask = (u32)1 << gate->en_bit; in __gate_commit()
430 __ccu_write(ccu, gate->offset, reg_val); in __gate_commit()
437 return __ccu_wait_bit(ccu, gate->offset, gate->status_bit, enabled); in __gate_commit()
484 /* Enable or disable a gate. Returns 0 if successful, -EIO otherwise */
514 return -EIO; in clk_gate()
520 * If a clock gate requires a turn-off delay it will have
535 offset = hyst->offset; in hyst_init()
536 mask = (u32)1 << hyst->en_bit; in hyst_init()
537 mask |= (u32)1 << hyst->val_bit; in hyst_init()
555 __ccu_write(ccu, trig->offset, 1 << trig->bit); in __clk_trigger()
557 return __ccu_wait_bit(ccu, trig->offset, trig->bit, false); in __clk_trigger()
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()
587 * Returns 0 on success. Returns -EINVAL for invalid arguments.
588 * Returns -ENXIO if gating failed, and -EIO if a trigger failed.
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()
620 ret = -ENXIO; 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()
632 ret = -EIO; in __div_commit()
636 ret = ret ? ret : -ENXIO; /* return first error */ in __div_commit()
664 previous = div->u.s.scaled_div; in divider_write()
668 div->u.s.scaled_div = scaled_div; in divider_write()
679 div->u.s.scaled_div = previous; /* Revert the change */ in divider_write()
689 * into account a divider and an optional pre-divider. The
690 * pre-divider register pointer may be NULL.
707 * If there is a pre-divider, divide the scaled parent rate in clk_recalc_rate()
708 * by the pre-divider value first. In this case--to improve in clk_recalc_rate()
709 * accuracy--scale the parent rate by *both* the pre-divider in clk_recalc_rate()
711 * result of the pre-divider. in clk_recalc_rate()
740 * into two dividers. The pre-divider can be NULL, and even if it's
741 * non-null it may be nonexistent. It's also OK for the divider to
742 * be nonexistent, and in that case the pre-divider is also ignored.
744 * If scaled_div is non-null, it is used to return the scaled divisor
763 * If there is a pre-divider, divide the scaled parent rate in round_rate()
764 * by the pre-divider value first. In this case--to improve in round_rate()
765 * accuracy--scale the parent rate by *both* the pre-divider in round_rate()
767 * result of the pre-divider. in round_rate()
771 * For simplicity we treat the pre-divider as fixed (for now). in round_rate()
824 BUG_ON(sel->parent_count > (u32)U8_MAX); in parent_index()
825 for (i = 0; i < sel->parent_count; i++) in parent_index()
826 if (sel->parent_sel[i] == parent_sel) in parent_index()
852 reg_val = __ccu_read(ccu, sel->offset); in selector_read_index()
855 parent_sel = bitfield_extract(reg_val, sel->shift, sel->width); in selector_read_index()
860 pr_err("%s: out-of-range parent selector %u (%s 0x%04x)\n", in selector_read_index()
861 __func__, parent_sel, ccu->name, sel->offset); in selector_read_index()
869 * Returns 0 on success. Returns -EINVAL for invalid arguments.
870 * Returns -ENXIO if gating failed, and -EIO if a trigger failed.
888 if (sel->clk_index == BAD_CLK_INDEX) { in __sel_commit()
891 reg_val = __ccu_read(ccu, sel->offset); in __sel_commit()
892 parent_sel = bitfield_extract(reg_val, sel->shift, sel->width); in __sel_commit()
895 return -EINVAL; in __sel_commit()
896 sel->clk_index = index; in __sel_commit()
901 BUG_ON((u32)sel->clk_index >= sel->parent_count); in __sel_commit()
902 parent_sel = sel->parent_sel[sel->clk_index]; in __sel_commit()
907 return -ENXIO; in __sel_commit()
910 reg_val = __ccu_read(ccu, sel->offset); in __sel_commit()
911 reg_val = bitfield_replace(reg_val, sel->shift, sel->width, parent_sel); in __sel_commit()
912 __ccu_write(ccu, sel->offset, reg_val); in __sel_commit()
916 ret = -EIO; in __sel_commit()
920 ret = ret ? ret : -ENXIO; /* return first error */ in __sel_commit()
951 previous = sel->clk_index; in selector_write()
955 sel->clk_index = index; in selector_write()
966 sel->clk_index = previous; /* Revert the change */ in selector_write()
976 struct bcm_clk_gate *gate = &bcm_clk->u.peri->gate; in kona_peri_clk_enable()
978 return clk_gate(bcm_clk->ccu, bcm_clk->init_data.name, gate, true); in kona_peri_clk_enable()
984 struct bcm_clk_gate *gate = &bcm_clk->u.peri->gate; in kona_peri_clk_disable()
986 (void)clk_gate(bcm_clk->ccu, bcm_clk->init_data.name, gate, false); in kona_peri_clk_disable()
992 struct bcm_clk_gate *gate = &bcm_clk->u.peri->gate; in kona_peri_clk_is_enabled()
994 return is_clk_gate_enabled(bcm_clk->ccu, gate) ? 1 : 0; in kona_peri_clk_is_enabled()
1001 struct peri_clk_data *data = bcm_clk->u.peri; in kona_peri_clk_recalc_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()
1017 return round_rate(bcm_clk->ccu, div, &bcm_clk->u.peri->pre_div, in kona_peri_clk_round_rate()
1022 struct clk_rate_request *req) in kona_peri_clk_determine_rate() argument
1037 WARN_ON_ONCE(bcm_clk->init_data.flags & CLK_SET_RATE_NO_REPARENT); in kona_peri_clk_determine_rate()
1038 parent_count = (u32)bcm_clk->init_data.num_parents; in kona_peri_clk_determine_rate()
1040 rate = kona_peri_clk_round_rate(hw, req->rate, in kona_peri_clk_determine_rate()
1041 &req->best_parent_rate); in kona_peri_clk_determine_rate()
1045 req->rate = rate; in kona_peri_clk_determine_rate()
1052 best_rate = kona_peri_clk_round_rate(hw, req->rate, &parent_rate); in kona_peri_clk_determine_rate()
1053 best_delta = abs(best_rate - req->rate); in kona_peri_clk_determine_rate()
1067 other_rate = kona_peri_clk_round_rate(hw, req->rate, in kona_peri_clk_determine_rate()
1069 delta = abs(other_rate - req->rate); in kona_peri_clk_determine_rate()
1073 req->best_parent_hw = parent; in kona_peri_clk_determine_rate()
1074 req->best_parent_rate = parent_rate; in kona_peri_clk_determine_rate()
1078 req->rate = best_rate; in kona_peri_clk_determine_rate()
1085 struct peri_clk_data *data = bcm_clk->u.peri; in kona_peri_clk_set_parent()
1086 struct bcm_clk_sel *sel = &data->sel; in kona_peri_clk_set_parent()
1090 BUG_ON(index >= sel->parent_count); in kona_peri_clk_set_parent()
1098 * pre-trigger we want to use that instead. in kona_peri_clk_set_parent()
1100 trig = trigger_exists(&data->pre_trig) ? &data->pre_trig in kona_peri_clk_set_parent()
1101 : &data->trig; in kona_peri_clk_set_parent()
1103 ret = selector_write(bcm_clk->ccu, &data->gate, sel, trig, index); in kona_peri_clk_set_parent()
1104 if (ret == -ENXIO) { in kona_peri_clk_set_parent()
1106 bcm_clk->init_data.name); in kona_peri_clk_set_parent()
1107 ret = -EIO; /* Don't proliferate weird errors */ in kona_peri_clk_set_parent()
1108 } else if (ret == -EIO) { in kona_peri_clk_set_parent()
1110 trig == &data->pre_trig ? "pre-" : "", in kona_peri_clk_set_parent()
1111 bcm_clk->init_data.name); in kona_peri_clk_set_parent()
1120 struct peri_clk_data *data = bcm_clk->u.peri; in kona_peri_clk_get_parent()
1123 index = selector_read_index(bcm_clk->ccu, &data->sel); in kona_peri_clk_get_parent()
1125 /* Not all callers would handle an out-of-range value gracefully */ in kona_peri_clk_get_parent()
1133 struct peri_clk_data *data = bcm_clk->u.peri; in kona_peri_clk_set_rate()
1134 struct bcm_clk_div *div = &data->div; in kona_peri_clk_set_rate()
1139 return -EINVAL; in kona_peri_clk_set_rate()
1145 return rate == parent_rate ? 0 : -EINVAL; in kona_peri_clk_set_rate()
1149 * pre-divider be, but for now we never actually try to in kona_peri_clk_set_rate()
1150 * change that.) Tolerate a request for a no-op change. in kona_peri_clk_set_rate()
1152 if (divider_is_fixed(&data->div)) in kona_peri_clk_set_rate()
1153 return rate == parent_rate ? 0 : -EINVAL; in kona_peri_clk_set_rate()
1160 (void)round_rate(bcm_clk->ccu, div, &data->pre_div, in kona_peri_clk_set_rate()
1164 * We aren't updating any pre-divider at this point, so in kona_peri_clk_set_rate()
1167 ret = divider_write(bcm_clk->ccu, &data->gate, &data->div, in kona_peri_clk_set_rate()
1168 &data->trig, scaled_div); in kona_peri_clk_set_rate()
1169 if (ret == -ENXIO) { in kona_peri_clk_set_rate()
1171 bcm_clk->init_data.name); in kona_peri_clk_set_rate()
1172 ret = -EIO; /* Don't proliferate weird errors */ in kona_peri_clk_set_rate()
1173 } else if (ret == -EIO) { in kona_peri_clk_set_rate()
1175 bcm_clk->init_data.name); in kona_peri_clk_set_rate()
1195 struct ccu_data *ccu = bcm_clk->ccu; in __peri_clk_init()
1196 struct peri_clk_data *peri = bcm_clk->u.peri; in __peri_clk_init()
1197 const char *name = bcm_clk->init_data.name; in __peri_clk_init()
1200 BUG_ON(bcm_clk->type != bcm_clk_peri); in __peri_clk_init()
1202 if (!policy_init(ccu, &peri->policy)) { in __peri_clk_init()
1207 if (!gate_init(ccu, &peri->gate)) { in __peri_clk_init()
1211 if (!hyst_init(ccu, &peri->hyst)) { in __peri_clk_init()
1215 if (!div_init(ccu, &peri->gate, &peri->div, &peri->trig)) { in __peri_clk_init()
1222 * For the pre-divider and selector, the pre-trigger is used in __peri_clk_init()
1225 trig = trigger_exists(&peri->pre_trig) ? &peri->pre_trig in __peri_clk_init()
1226 : &peri->trig; in __peri_clk_init()
1228 if (!div_init(ccu, &peri->gate, &peri->pre_div, trig)) { in __peri_clk_init()
1229 pr_err("%s: error initializing pre-divider for %s\n", __func__, in __peri_clk_init()
1234 if (!sel_init(ccu, &peri->gate, &peri->sel, trig)) { in __peri_clk_init()
1245 switch (bcm_clk->type) { in __kona_clk_init()
1259 struct kona_clk *kona_clks = ccu->kona_clks; in kona_ccu_init()
1265 for (which = 0; which < ccu->clk_num; which++) { in kona_ccu_init()
1268 if (!bcm_clk->ccu) in kona_ccu_init()