Lines Matching refs:data
103 static int si570_get_divs(struct clk_si570 *data, u64 *rfreq, in si570_get_divs() argument
110 err = regmap_bulk_read(data->regmap, SI570_REG_HS_N1 + data->div_offset, in si570_get_divs()
137 static int si570_get_defaults(struct clk_si570 *data, u64 fout) in si570_get_defaults() argument
142 regmap_write(data->regmap, SI570_REG_CONTROL, SI570_CNTRL_RECALL); in si570_get_defaults()
144 err = si570_get_divs(data, &data->rfreq, &data->n1, &data->hs_div); in si570_get_defaults()
152 fdco = fout * data->n1 * data->hs_div; in si570_get_defaults()
154 data->fxtal = div64_u64(fdco << 24, data->rfreq >> 4); in si570_get_defaults()
156 data->fxtal = div64_u64(fdco << 28, data->rfreq); in si570_get_defaults()
158 data->frequency = fout; in si570_get_defaults()
168 static int si570_update_rfreq(struct clk_si570 *data) in si570_update_rfreq() argument
172 reg[0] = ((data->n1 - 1) << 6) | in si570_update_rfreq()
173 ((data->rfreq >> 32) & RFREQ_37_32_MASK); in si570_update_rfreq()
174 reg[1] = (data->rfreq >> 24) & 0xff; in si570_update_rfreq()
175 reg[2] = (data->rfreq >> 16) & 0xff; in si570_update_rfreq()
176 reg[3] = (data->rfreq >> 8) & 0xff; in si570_update_rfreq()
177 reg[4] = data->rfreq & 0xff; in si570_update_rfreq()
179 return regmap_bulk_write(data->regmap, SI570_REG_N1_RFREQ0 + in si570_update_rfreq()
180 data->div_offset, reg, ARRAY_SIZE(reg)); in si570_update_rfreq()
195 static int si570_calc_divs(unsigned long frequency, struct clk_si570 *data, in si570_calc_divs() argument
216 *out_rfreq = div64_u64(fdco << 28, data->fxtal); in si570_calc_divs()
235 struct clk_si570 *data = to_clk_si570(hw); in si570_recalc_rate() local
237 err = si570_get_divs(data, &rfreq, &n1, &hs_div); in si570_recalc_rate()
239 dev_err(&data->i2c_client->dev, "unable to recalc rate\n"); in si570_recalc_rate()
240 return data->frequency; in si570_recalc_rate()
244 rate = (data->fxtal * rfreq) >> 28; in si570_recalc_rate()
255 struct clk_si570 *data = to_clk_si570(hw); in si570_round_rate() local
260 if (div64_u64(abs(rate - data->frequency) * 10000LL, in si570_round_rate()
261 data->frequency) < 35) { in si570_round_rate()
262 rfreq = div64_u64((data->rfreq * rate) + in si570_round_rate()
263 div64_u64(data->frequency, 2), data->frequency); in si570_round_rate()
264 n1 = data->n1; in si570_round_rate()
265 hs_div = data->hs_div; in si570_round_rate()
268 err = si570_calc_divs(rate, data, &rfreq, &n1, &hs_div); in si570_round_rate()
270 dev_err(&data->i2c_client->dev, in si570_round_rate()
287 static int si570_set_frequency(struct clk_si570 *data, unsigned long frequency) in si570_set_frequency() argument
291 err = si570_calc_divs(frequency, data, &data->rfreq, &data->n1, in si570_set_frequency()
292 &data->hs_div); in si570_set_frequency()
300 regmap_write(data->regmap, SI570_REG_FREEZE_DCO, SI570_FREEZE_DCO); in si570_set_frequency()
301 regmap_write(data->regmap, SI570_REG_HS_N1 + data->div_offset, in si570_set_frequency()
302 ((data->hs_div - HS_DIV_OFFSET) << HS_DIV_SHIFT) | in si570_set_frequency()
303 (((data->n1 - 1) >> 2) & N1_6_2_MASK)); in si570_set_frequency()
304 si570_update_rfreq(data); in si570_set_frequency()
305 regmap_write(data->regmap, SI570_REG_FREEZE_DCO, 0); in si570_set_frequency()
306 regmap_write(data->regmap, SI570_REG_CONTROL, SI570_CNTRL_NEWFREQ); in si570_set_frequency()
322 static int si570_set_frequency_small(struct clk_si570 *data, in si570_set_frequency_small() argument
330 data->rfreq = div64_u64((data->rfreq * frequency) + in si570_set_frequency_small()
331 div_u64(data->frequency, 2), data->frequency); in si570_set_frequency_small()
332 regmap_write(data->regmap, SI570_REG_CONTROL, SI570_CNTRL_FREEZE_M); in si570_set_frequency_small()
333 si570_update_rfreq(data); in si570_set_frequency_small()
334 regmap_write(data->regmap, SI570_REG_CONTROL, 0); in si570_set_frequency_small()
345 struct clk_si570 *data = to_clk_si570(hw); in si570_set_rate() local
346 struct i2c_client *client = data->i2c_client; in si570_set_rate()
349 if (rate < SI570_MIN_FREQ || rate > data->max_freq) { in si570_set_rate()
355 if (div64_u64(abs(rate - data->frequency) * 10000LL, in si570_set_rate()
356 data->frequency) < 35) in si570_set_rate()
357 err = si570_set_frequency_small(data, rate); in si570_set_rate()
359 err = si570_set_frequency(data, rate); in si570_set_rate()
364 data->frequency = rate; in si570_set_rate()
409 struct clk_si570 *data; in si570_probe() local
416 data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL); in si570_probe()
417 if (!data) in si570_probe()
423 data->hw.init = &init; in si570_probe()
424 data->i2c_client = client; in si570_probe()
436 data->div_offset = SI570_DIV_OFFSET_7PPM; in si570_probe()
438 data->max_freq = SI570_MAX_FREQ; in si570_probe()
440 data->max_freq = SI598_MAX_FREQ; in si570_probe()
454 data->regmap = devm_regmap_init_i2c(client, &si570_regmap_config); in si570_probe()
455 if (IS_ERR(data->regmap)) { in si570_probe()
457 return PTR_ERR(data->regmap); in si570_probe()
460 i2c_set_clientdata(client, data); in si570_probe()
461 err = si570_get_defaults(data, factory_fout); in si570_probe()
465 clk = devm_clk_register(&client->dev, &data->hw); in si570_probe()
489 data->frequency); in si570_probe()