Lines Matching refs:st
79 static int adf4350_sync_config(struct adf4350_state *st) in adf4350_sync_config() argument
84 if ((st->regs_hw[i] != st->regs[i]) || in adf4350_sync_config()
93 st->val = cpu_to_be32(st->regs[i] | i); in adf4350_sync_config()
94 ret = spi_write(st->spi, &st->val, 4); in adf4350_sync_config()
97 st->regs_hw[i] = st->regs[i]; in adf4350_sync_config()
98 dev_dbg(&st->spi->dev, "[%d] 0x%X\n", in adf4350_sync_config()
99 i, (u32)st->regs[i] | i); in adf4350_sync_config()
109 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_reg_access() local
115 mutex_lock(&st->lock); in adf4350_reg_access()
117 st->regs[reg] = writeval & ~(BIT(0) | BIT(1) | BIT(2)); in adf4350_reg_access()
118 ret = adf4350_sync_config(st); in adf4350_reg_access()
120 *readval = st->regs_hw[reg]; in adf4350_reg_access()
123 mutex_unlock(&st->lock); in adf4350_reg_access()
128 static int adf4350_tune_r_cnt(struct adf4350_state *st, unsigned short r_cnt) in adf4350_tune_r_cnt() argument
130 struct adf4350_platform_data *pdata = st->pdata; in adf4350_tune_r_cnt()
134 st->fpfd = (st->clkin * (pdata->ref_doubler_en ? 2 : 1)) / in adf4350_tune_r_cnt()
136 } while (st->fpfd > ADF4350_MAX_FREQ_PFD); in adf4350_tune_r_cnt()
141 static int adf4350_set_freq(struct adf4350_state *st, unsigned long long freq) in adf4350_set_freq() argument
143 struct adf4350_platform_data *pdata = st->pdata; in adf4350_set_freq()
149 if (freq > ADF4350_MAX_OUT_FREQ || freq < st->min_out_freq) in adf4350_set_freq()
152 st->r4_rf_div_sel = 0; in adf4350_set_freq()
162 st->r4_rf_div_sel++; in adf4350_set_freq()
180 chspc = st->chspc; in adf4350_set_freq()
185 r_cnt = adf4350_tune_r_cnt(st, r_cnt); in adf4350_set_freq()
186 st->r1_mod = st->fpfd / chspc; in adf4350_set_freq()
192 } while ((st->r1_mod > ADF4350_MAX_MODULUS) && r_cnt); in adf4350_set_freq()
195 tmp = freq * (u64)st->r1_mod + (st->fpfd >> 1); in adf4350_set_freq()
196 do_div(tmp, st->fpfd); /* Div round closest (n + d/2)/d */ in adf4350_set_freq()
197 st->r0_fract = do_div(tmp, st->r1_mod); in adf4350_set_freq()
198 st->r0_int = tmp; in adf4350_set_freq()
199 } while (mdiv > st->r0_int); in adf4350_set_freq()
201 band_sel_div = DIV_ROUND_UP(st->fpfd, ADF4350_MAX_BANDSEL_CLK); in adf4350_set_freq()
203 if (st->r0_fract && st->r1_mod) { in adf4350_set_freq()
204 div_gcd = gcd(st->r1_mod, st->r0_fract); in adf4350_set_freq()
205 st->r1_mod /= div_gcd; in adf4350_set_freq()
206 st->r0_fract /= div_gcd; in adf4350_set_freq()
208 st->r0_fract = 0; in adf4350_set_freq()
209 st->r1_mod = 1; in adf4350_set_freq()
212 dev_dbg(&st->spi->dev, "VCO: %llu Hz, PFD %lu Hz\n" in adf4350_set_freq()
215 freq, st->fpfd, r_cnt, st->r0_int, st->r0_fract, st->r1_mod, in adf4350_set_freq()
216 1 << st->r4_rf_div_sel, prescaler ? "8/9" : "4/5", in adf4350_set_freq()
219 st->regs[ADF4350_REG0] = ADF4350_REG0_INT(st->r0_int) | in adf4350_set_freq()
220 ADF4350_REG0_FRACT(st->r0_fract); in adf4350_set_freq()
222 st->regs[ADF4350_REG1] = ADF4350_REG1_PHASE(1) | in adf4350_set_freq()
223 ADF4350_REG1_MOD(st->r1_mod) | in adf4350_set_freq()
226 st->regs[ADF4350_REG2] = in adf4350_set_freq()
236 st->regs[ADF4350_REG3] = pdata->r3_user_settings & in adf4350_set_freq()
244 st->regs[ADF4350_REG4] = in adf4350_set_freq()
246 ADF4350_REG4_RF_DIV_SEL(st->r4_rf_div_sel) | in adf4350_set_freq()
256 st->regs[ADF4350_REG5] = ADF4350_REG5_LD_PIN_MODE_DIGITAL; in adf4350_set_freq()
257 st->freq_req = freq; in adf4350_set_freq()
259 return adf4350_sync_config(st); in adf4350_set_freq()
267 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_write() local
276 mutex_lock(&st->lock); in adf4350_write()
279 ret = adf4350_set_freq(st, readin); in adf4350_write()
287 if (st->clk) { in adf4350_write()
288 tmp = clk_round_rate(st->clk, readin); in adf4350_write()
293 ret = clk_set_rate(st->clk, tmp); in adf4350_write()
297 st->clkin = readin; in adf4350_write()
298 ret = adf4350_set_freq(st, st->freq_req); in adf4350_write()
304 st->chspc = readin; in adf4350_write()
308 st->regs[ADF4350_REG2] |= ADF4350_REG2_POWER_DOWN_EN; in adf4350_write()
310 st->regs[ADF4350_REG2] &= ~ADF4350_REG2_POWER_DOWN_EN; in adf4350_write()
312 adf4350_sync_config(st); in adf4350_write()
317 mutex_unlock(&st->lock); in adf4350_write()
327 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_read() local
331 mutex_lock(&st->lock); in adf4350_read()
334 val = (u64)((st->r0_int * st->r1_mod) + st->r0_fract) * in adf4350_read()
335 (u64)st->fpfd; in adf4350_read()
336 do_div(val, st->r1_mod * (1 << st->r4_rf_div_sel)); in adf4350_read()
338 if (st->lock_detect_gpiod) in adf4350_read()
339 if (!gpiod_get_value(st->lock_detect_gpiod)) { in adf4350_read()
340 dev_dbg(&st->spi->dev, "PLL un-locked\n"); in adf4350_read()
345 if (st->clk) in adf4350_read()
346 st->clkin = clk_get_rate(st->clk); in adf4350_read()
348 val = st->clkin; in adf4350_read()
351 val = st->chspc; in adf4350_read()
354 val = !!(st->regs[ADF4350_REG2] & ADF4350_REG2_POWER_DOWN_EN); in adf4350_read()
360 mutex_unlock(&st->lock); in adf4350_read()
398 struct adf4350_state *st = data; in adf4350_clk_del_provider() local
400 of_clk_del_provider(st->spi->dev.of_node); in adf4350_clk_del_provider()
406 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_recalc_rate() local
409 tmp = (u64)(st->r0_int * st->r1_mod + st->r0_fract) * st->fpfd; in adf4350_clk_recalc_rate()
410 do_div(tmp, st->r1_mod * (1 << st->r4_rf_div_sel)); in adf4350_clk_recalc_rate()
419 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_set_rate() local
424 st->clkin = parent_rate; in adf4350_clk_set_rate()
426 return adf4350_set_freq(st, rate); in adf4350_clk_set_rate()
431 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_prepare() local
433 st->regs[ADF4350_REG2] &= ~ADF4350_REG2_POWER_DOWN_EN; in adf4350_clk_prepare()
435 return adf4350_sync_config(st); in adf4350_clk_prepare()
440 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_unprepare() local
442 st->regs[ADF4350_REG2] |= ADF4350_REG2_POWER_DOWN_EN; in adf4350_clk_unprepare()
444 adf4350_sync_config(st); in adf4350_clk_unprepare()
449 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_is_enabled() local
451 return (st->regs[ADF4350_REG2] & ADF4350_REG2_POWER_DOWN_EN); in adf4350_clk_is_enabled()
462 static int adf4350_clk_register(struct adf4350_state *st) in adf4350_clk_register() argument
464 struct spi_device *spi = st->spi; in adf4350_clk_register()
489 st->hw.init = &init; in adf4350_clk_register()
490 clk = devm_clk_register(&spi->dev, &st->hw); in adf4350_clk_register()
498 st->clkout = clk; in adf4350_clk_register()
500 return devm_add_action_or_reset(&spi->dev, adf4350_clk_del_provider, st); in adf4350_clk_register()
593 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_power_down() local
595 st->regs[ADF4350_REG2] |= ADF4350_REG2_POWER_DOWN_EN; in adf4350_power_down()
596 adf4350_sync_config(st); in adf4350_power_down()
603 struct adf4350_state *st; in adf4350_probe() local
626 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); in adf4350_probe()
630 st = iio_priv(indio_dev); in adf4350_probe()
636 st->spi = spi; in adf4350_probe()
637 st->pdata = pdata; in adf4350_probe()
645 mutex_init(&st->lock); in adf4350_probe()
647 st->chspc = pdata->channel_spacing; in adf4350_probe()
649 st->clk = clk; in adf4350_probe()
650 st->clkin = clk_get_rate(clk); in adf4350_probe()
652 st->clkin = pdata->clkin; in adf4350_probe()
655 st->min_out_freq = spi_get_device_id(spi)->driver_data == 4351 ? in adf4350_probe()
658 memset(st->regs_hw, 0xFF, sizeof(st->regs_hw)); in adf4350_probe()
660 st->lock_detect_gpiod = devm_gpiod_get_optional(&spi->dev, NULL, in adf4350_probe()
662 if (IS_ERR(st->lock_detect_gpiod)) in adf4350_probe()
663 return PTR_ERR(st->lock_detect_gpiod); in adf4350_probe()
666 ret = adf4350_set_freq(st, pdata->power_up_frequency); in adf4350_probe()
671 ret = adf4350_clk_register(st); in adf4350_probe()
675 if (!st->clkout) { in adf4350_probe()