clk/spear/clk-aux-synth.c

9 #define pr_fmt(fmt) "clk-aux-synth: " fmt
44 	struct clk_aux *aux = to_clk_aux(hw);
45 	struct aux_rate_tbl *rtbl = aux->rtbl;
55 	struct clk_aux *aux = to_clk_aux(hw);
59 			aux->rtbl_cnt, &unused);
65 	struct clk_aux *aux = to_clk_aux(hw);
69 	if (aux->lock)
70 		spin_lock_irqsave(aux->lock, flags);
72 	val = readl_relaxed(aux->reg);
74 	if (aux->lock)
75 		spin_unlock_irqrestore(aux->lock, flags);
77 	eqn = (val >> aux->masks->eq_sel_shift) & aux->masks->eq_sel_mask;
78 	if (eqn == aux->masks->eq1_mask)
82 	num = (val >> aux->masks->xscale_sel_shift) &
83 		aux->masks->xscale_sel_mask;
86 	den *= (val >> aux->masks->yscale_sel_shift) &
87 		aux->masks->yscale_sel_mask;
95 /* Configures new clock rate of aux */
99 	struct clk_aux *aux = to_clk_aux(hw);
100 	struct aux_rate_tbl *rtbl = aux->rtbl;
104 	clk_round_rate_index(hw, drate, prate, aux_calc_rate, aux->rtbl_cnt,
107 	if (aux->lock)
108 		spin_lock_irqsave(aux->lock, flags);
110 	val = readl_relaxed(aux->reg) &
111 		~(aux->masks->eq_sel_mask << aux->masks->eq_sel_shift);
112 	val |= (rtbl[i].eq & aux->masks->eq_sel_mask) <<
113 		aux->masks->eq_sel_shift;
114 	val &= ~(aux->masks->xscale_sel_mask << aux->masks->xscale_sel_shift);
115 	val |= (rtbl[i].xscale & aux->masks->xscale_sel_mask) <<
116 		aux->masks->xscale_sel_shift;
117 	val &= ~(aux->masks->yscale_sel_mask << aux->masks->yscale_sel_shift);
118 	val |= (rtbl[i].yscale & aux->masks->yscale_sel_mask) <<
119 		aux->masks->yscale_sel_shift;
120 	writel_relaxed(val, aux->reg);
122 	if (aux->lock)
123 		spin_unlock_irqrestore(aux->lock, flags);
139 	struct clk_aux *aux;
148 	aux = kzalloc(sizeof(*aux), GFP_KERNEL);
149 	if (!aux)
154 		aux->masks = &default_aux_masks;
156 		aux->masks = masks;
158 	aux->reg = reg;
159 	aux->rtbl = rtbl;
160 	aux->rtbl_cnt = rtbl_cnt;
161 	aux->lock = lock;
162 	aux->hw.init = &init;
170 	clk = clk_register(NULL, &aux->hw);
179 				aux->masks->enable_bit, 0, lock);
190 	kfree(aux);