Lines Matching full: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()
160 st->r4_rf_div_sel = 0; in adf4350_set_freq()
164 st->r4_rf_div_sel++; in adf4350_set_freq()
174 chspc = st->chspc; in adf4350_set_freq()
179 r_cnt = adf4350_tune_r_cnt(st, r_cnt); in adf4350_set_freq()
180 st->r1_mod = st->fpfd / chspc; in adf4350_set_freq()
186 } while ((st->r1_mod > ADF4350_MAX_MODULUS) && r_cnt); in adf4350_set_freq()
189 tmp = freq * (u64)st->r1_mod + (st->fpfd >> 1); in adf4350_set_freq()
190 do_div(tmp, st->fpfd); /* Div round closest (n + d/2)/d */ in adf4350_set_freq()
191 st->r0_fract = do_div(tmp, st->r1_mod); in adf4350_set_freq()
192 st->r0_int = tmp; in adf4350_set_freq()
193 } while (mdiv > st->r0_int); in adf4350_set_freq()
195 band_sel_div = DIV_ROUND_UP(st->fpfd, ADF4350_MAX_BANDSEL_CLK); in adf4350_set_freq()
197 if (st->r0_fract && st->r1_mod) { in adf4350_set_freq()
198 div_gcd = gcd(st->r1_mod, st->r0_fract); in adf4350_set_freq()
199 st->r1_mod /= div_gcd; in adf4350_set_freq()
200 st->r0_fract /= div_gcd; in adf4350_set_freq()
202 st->r0_fract = 0; in adf4350_set_freq()
203 st->r1_mod = 1; in adf4350_set_freq()
206 dev_dbg(&st->spi->dev, "VCO: %llu Hz, PFD %lu Hz\n" in adf4350_set_freq()
209 freq, st->fpfd, r_cnt, st->r0_int, st->r0_fract, st->r1_mod, in adf4350_set_freq()
210 1 << st->r4_rf_div_sel, prescaler ? "8/9" : "4/5", in adf4350_set_freq()
213 st->regs[ADF4350_REG0] = ADF4350_REG0_INT(st->r0_int) | in adf4350_set_freq()
214 ADF4350_REG0_FRACT(st->r0_fract); in adf4350_set_freq()
216 st->regs[ADF4350_REG1] = ADF4350_REG1_PHASE(1) | in adf4350_set_freq()
217 ADF4350_REG1_MOD(st->r1_mod) | in adf4350_set_freq()
220 st->regs[ADF4350_REG2] = in adf4350_set_freq()
230 st->regs[ADF4350_REG3] = pdata->r3_user_settings & in adf4350_set_freq()
238 st->regs[ADF4350_REG4] = in adf4350_set_freq()
240 ADF4350_REG4_RF_DIV_SEL(st->r4_rf_div_sel) | in adf4350_set_freq()
250 st->regs[ADF4350_REG5] = ADF4350_REG5_LD_PIN_MODE_DIGITAL; in adf4350_set_freq()
251 st->freq_req = freq; in adf4350_set_freq()
253 return adf4350_sync_config(st); in adf4350_set_freq()
261 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_write() local
270 mutex_lock(&st->lock); in adf4350_write()
273 ret = adf4350_set_freq(st, readin); in adf4350_write()
281 if (st->clk) { in adf4350_write()
282 tmp = clk_round_rate(st->clk, readin); in adf4350_write()
287 ret = clk_set_rate(st->clk, tmp); in adf4350_write()
291 st->clkin = readin; in adf4350_write()
292 ret = adf4350_set_freq(st, st->freq_req); in adf4350_write()
298 st->chspc = readin; in adf4350_write()
302 st->regs[ADF4350_REG2] |= ADF4350_REG2_POWER_DOWN_EN; in adf4350_write()
304 st->regs[ADF4350_REG2] &= ~ADF4350_REG2_POWER_DOWN_EN; in adf4350_write()
306 adf4350_sync_config(st); in adf4350_write()
311 mutex_unlock(&st->lock); in adf4350_write()
321 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_read() local
325 mutex_lock(&st->lock); in adf4350_read()
328 val = (u64)((st->r0_int * st->r1_mod) + st->r0_fract) * in adf4350_read()
329 (u64)st->fpfd; in adf4350_read()
330 do_div(val, st->r1_mod * (1 << st->r4_rf_div_sel)); in adf4350_read()
332 if (st->lock_detect_gpiod) in adf4350_read()
333 if (!gpiod_get_value(st->lock_detect_gpiod)) { in adf4350_read()
334 dev_dbg(&st->spi->dev, "PLL un-locked\n"); in adf4350_read()
339 if (st->clk) in adf4350_read()
340 st->clkin = clk_get_rate(st->clk); in adf4350_read()
342 val = st->clkin; in adf4350_read()
345 val = st->chspc; in adf4350_read()
348 val = !!(st->regs[ADF4350_REG2] & ADF4350_REG2_POWER_DOWN_EN); in adf4350_read()
354 mutex_unlock(&st->lock); in adf4350_read()
392 struct adf4350_state *st = data; in adf4350_clk_del_provider() local
394 of_clk_del_provider(st->spi->dev.of_node); in adf4350_clk_del_provider()
400 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_recalc_rate() local
403 tmp = (u64)(st->r0_int * st->r1_mod + st->r0_fract) * st->fpfd; in adf4350_clk_recalc_rate()
404 do_div(tmp, st->r1_mod * (1 << st->r4_rf_div_sel)); in adf4350_clk_recalc_rate()
413 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_set_rate() local
418 st->clkin = parent_rate; in adf4350_clk_set_rate()
420 return adf4350_set_freq(st, rate); in adf4350_clk_set_rate()
425 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_prepare() local
427 st->regs[ADF4350_REG2] &= ~ADF4350_REG2_POWER_DOWN_EN; in adf4350_clk_prepare()
429 return adf4350_sync_config(st); in adf4350_clk_prepare()
434 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_unprepare() local
436 st->regs[ADF4350_REG2] |= ADF4350_REG2_POWER_DOWN_EN; in adf4350_clk_unprepare()
438 adf4350_sync_config(st); in adf4350_clk_unprepare()
443 struct adf4350_state *st = to_adf4350_state(hw); in adf4350_clk_is_enabled() local
445 return (st->regs[ADF4350_REG2] & ADF4350_REG2_POWER_DOWN_EN); in adf4350_clk_is_enabled()
456 static int adf4350_clk_register(struct adf4350_state *st) in adf4350_clk_register() argument
458 struct spi_device *spi = st->spi; in adf4350_clk_register()
483 st->hw.init = &init; in adf4350_clk_register()
484 clk = devm_clk_register(&spi->dev, &st->hw); in adf4350_clk_register()
492 st->clkout = clk; in adf4350_clk_register()
494 return devm_add_action_or_reset(&spi->dev, adf4350_clk_del_provider, st); in adf4350_clk_register()
587 struct adf4350_state *st = iio_priv(indio_dev); in adf4350_power_down() local
589 st->regs[ADF4350_REG2] |= ADF4350_REG2_POWER_DOWN_EN; in adf4350_power_down()
590 adf4350_sync_config(st); in adf4350_power_down()
597 struct adf4350_state *st; in adf4350_probe() local
620 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*st)); in adf4350_probe()
624 st = iio_priv(indio_dev); in adf4350_probe()
630 st->spi = spi; in adf4350_probe()
631 st->pdata = pdata; in adf4350_probe()
639 mutex_init(&st->lock); in adf4350_probe()
641 st->chspc = pdata->channel_spacing; in adf4350_probe()
643 st->clk = clk; in adf4350_probe()
644 st->clkin = clk_get_rate(clk); in adf4350_probe()
646 st->clkin = pdata->clkin; in adf4350_probe()
649 st->min_out_freq = spi_get_device_id(spi)->driver_data == 4351 ? in adf4350_probe()
652 memset(st->regs_hw, 0xFF, sizeof(st->regs_hw)); in adf4350_probe()
654 st->lock_detect_gpiod = devm_gpiod_get_optional(&spi->dev, NULL, in adf4350_probe()
656 if (IS_ERR(st->lock_detect_gpiod)) in adf4350_probe()
657 return PTR_ERR(st->lock_detect_gpiod); in adf4350_probe()
660 ret = adf4350_set_freq(st, pdata->power_up_frequency); in adf4350_probe()
665 ret = adf4350_clk_register(st); in adf4350_probe()
669 if (!st->clkout) { in adf4350_probe()