Lines Matching refs:drvdata
77 static inline void cc_iowrite(struct cctrng_drvdata *drvdata, u32 reg, u32 val) in cc_iowrite() argument
79 iowrite32(val, (drvdata->cc_base + reg)); in cc_iowrite()
81 static inline u32 cc_ioread(struct cctrng_drvdata *drvdata, u32 reg) in cc_ioread() argument
83 return ioread32(drvdata->cc_base + reg); in cc_ioread()
106 static int cc_trng_pm_init(struct cctrng_drvdata *drvdata) in cc_trng_pm_init() argument
108 struct device *dev = &(drvdata->pdev->dev); in cc_trng_pm_init()
117 static void cc_trng_pm_go(struct cctrng_drvdata *drvdata) in cc_trng_pm_go() argument
119 struct device *dev = &(drvdata->pdev->dev); in cc_trng_pm_go()
125 static void cc_trng_pm_fini(struct cctrng_drvdata *drvdata) in cc_trng_pm_fini() argument
127 struct device *dev = &(drvdata->pdev->dev); in cc_trng_pm_fini()
133 static inline int cc_trng_parse_sampling_ratio(struct cctrng_drvdata *drvdata) in cc_trng_parse_sampling_ratio() argument
135 struct device *dev = &(drvdata->pdev->dev); in cc_trng_parse_sampling_ratio()
136 struct device_node *np = drvdata->pdev->dev.of_node; in cc_trng_parse_sampling_ratio()
143 drvdata->smpl_ratio, in cc_trng_parse_sampling_ratio()
153 i, drvdata->smpl_ratio[i]); in cc_trng_parse_sampling_ratio()
155 if (drvdata->smpl_ratio[i] > 0) in cc_trng_parse_sampling_ratio()
162 static int cc_trng_change_rosc(struct cctrng_drvdata *drvdata) in cc_trng_change_rosc() argument
164 struct device *dev = &(drvdata->pdev->dev); in cc_trng_change_rosc()
166 dev_dbg(dev, "cctrng change rosc (was %d)\n", drvdata->active_rosc); in cc_trng_change_rosc()
167 drvdata->active_rosc += 1; in cc_trng_change_rosc()
169 while (drvdata->active_rosc < CC_TRNG_NUM_OF_ROSCS) { in cc_trng_change_rosc()
170 if (drvdata->smpl_ratio[drvdata->active_rosc] > 0) in cc_trng_change_rosc()
173 drvdata->active_rosc += 1; in cc_trng_change_rosc()
179 static void cc_trng_enable_rnd_source(struct cctrng_drvdata *drvdata) in cc_trng_enable_rnd_source() argument
184 max_cycles = CCTRNG_TIMEOUT(drvdata->smpl_ratio[drvdata->active_rosc]); in cc_trng_enable_rnd_source()
185 cc_iowrite(drvdata, CC_RNG_WATCHDOG_VAL_REG_OFFSET, max_cycles); in cc_trng_enable_rnd_source()
188 cc_iowrite(drvdata, CC_RND_SOURCE_ENABLE_REG_OFFSET, 0x1); in cc_trng_enable_rnd_source()
191 cc_iowrite(drvdata, CC_RNG_IMR_REG_OFFSET, (u32)~CC_RNG_INT_MASK); in cc_trng_enable_rnd_source()
202 static inline size_t circ_buf_space(struct cctrng_drvdata *drvdata) in circ_buf_space() argument
204 return CIRC_SPACE(drvdata->circ.head, in circ_buf_space()
205 drvdata->circ.tail, CCTRNG_DATA_BUF_WORDS); in circ_buf_space()
213 struct cctrng_drvdata *drvdata = (struct cctrng_drvdata *)rng->priv; in cctrng_read() local
214 struct device *dev = &(drvdata->pdev->dev); in cctrng_read()
215 u32 *buf = (u32 *)drvdata->circ.buf; in cctrng_read()
221 if (!spin_trylock(&drvdata->read_lock)) { in cctrng_read()
228 cnt_w = CIRC_CNT_TO_END(drvdata->circ.head, in cctrng_read()
229 drvdata->circ.tail, CCTRNG_DATA_BUF_WORDS); in cctrng_read()
231 memcpy(data, &(buf[drvdata->circ.tail]), size); in cctrng_read()
233 circ_idx_inc(&drvdata->circ.tail, size); in cctrng_read()
237 cnt_w = CIRC_CNT(drvdata->circ.head, in cctrng_read()
238 drvdata->circ.tail, CCTRNG_DATA_BUF_WORDS); in cctrng_read()
240 memcpy(data, &(buf[drvdata->circ.tail]), size); in cctrng_read()
242 circ_idx_inc(&drvdata->circ.tail, size); in cctrng_read()
245 spin_unlock(&drvdata->read_lock); in cctrng_read()
247 if (circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) { in cctrng_read()
248 if (atomic_cmpxchg(&drvdata->pending_hw, 0, 1) == 0) { in cctrng_read()
250 if (circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) { in cctrng_read()
264 schedule_work(&drvdata->startwork); in cctrng_read()
266 atomic_set(&drvdata->pending_hw, 0); in cctrng_read()
274 static void cc_trng_hw_trigger(struct cctrng_drvdata *drvdata) in cc_trng_hw_trigger() argument
277 struct device *dev = &(drvdata->pdev->dev); in cc_trng_hw_trigger()
282 cc_iowrite(drvdata, CC_RNG_CLK_ENABLE_REG_OFFSET, 0x1); in cc_trng_hw_trigger()
285 cc_iowrite(drvdata, CC_RNG_SW_RESET_REG_OFFSET, 0x1); in cc_trng_hw_trigger()
291 cc_iowrite(drvdata, CC_RNG_CLK_ENABLE_REG_OFFSET, 0x1); in cc_trng_hw_trigger()
294 cc_iowrite(drvdata, CC_SAMPLE_CNT1_REG_OFFSET, in cc_trng_hw_trigger()
295 drvdata->smpl_ratio[drvdata->active_rosc]); in cc_trng_hw_trigger()
298 tmp_smpl_cnt = cc_ioread(drvdata, CC_SAMPLE_CNT1_REG_OFFSET); in cc_trng_hw_trigger()
300 } while (tmp_smpl_cnt != drvdata->smpl_ratio[drvdata->active_rosc]); in cc_trng_hw_trigger()
303 cc_iowrite(drvdata, CC_RND_SOURCE_ENABLE_REG_OFFSET, 0); in cc_trng_hw_trigger()
305 cc_iowrite(drvdata, CC_RNG_ICR_REG_OFFSET, 0xFFFFFFFF); in cc_trng_hw_trigger()
307 cc_iowrite(drvdata, CC_TRNG_CONFIG_REG_OFFSET, drvdata->active_rosc); in cc_trng_hw_trigger()
310 cc_iowrite(drvdata, CC_TRNG_DEBUG_CONTROL_REG_OFFSET, 0); in cc_trng_hw_trigger()
312 cc_trng_enable_rnd_source(drvdata); in cc_trng_hw_trigger()
319 struct cctrng_drvdata *drvdata = in cc_trng_compwork_handler() local
321 struct device *dev = &(drvdata->pdev->dev); in cc_trng_compwork_handler()
325 cc_iowrite(drvdata, CC_RNG_DMA_ENABLE_REG_OFFSET, 0); in cc_trng_compwork_handler()
326 cc_iowrite(drvdata, CC_RND_SOURCE_ENABLE_REG_OFFSET, 0); in cc_trng_compwork_handler()
329 isr = cc_ioread(drvdata, CC_RNG_ISR_REG_OFFSET); in cc_trng_compwork_handler()
340 cc_iowrite(drvdata, CC_RNG_ICR_REG_OFFSET, isr); in cc_trng_compwork_handler()
357 u32 *buf = (u32 *)drvdata->circ.buf; in cc_trng_compwork_handler()
359 buf[drvdata->circ.head] = cc_ioread(drvdata, in cc_trng_compwork_handler()
365 if (buf[drvdata->circ.head] == 0) { in cc_trng_compwork_handler()
367 drvdata->active_rosc); in cc_trng_compwork_handler()
371 circ_idx_inc(&drvdata->circ.head, 1<<2); in cc_trng_compwork_handler()
374 atomic_set(&drvdata->pending_hw, 0); in cc_trng_compwork_handler()
377 if (circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) { in cc_trng_compwork_handler()
378 if (atomic_cmpxchg(&drvdata->pending_hw, 0, 1) == 0) { in cc_trng_compwork_handler()
380 cc_trng_enable_rnd_source(drvdata); in cc_trng_compwork_handler()
391 if ((circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) && in cc_trng_compwork_handler()
392 (cc_trng_change_rosc(drvdata) == 0)) { in cc_trng_compwork_handler()
394 cc_trng_hw_trigger(drvdata); in cc_trng_compwork_handler()
396 atomic_set(&drvdata->pending_hw, 0); in cc_trng_compwork_handler()
403 struct cctrng_drvdata *drvdata = (struct cctrng_drvdata *)dev_id; in cc_isr() local
404 struct device *dev = &(drvdata->pdev->dev); in cc_isr()
412 irr = cc_ioread(drvdata, CC_HOST_RGF_IRR_REG_OFFSET); in cc_isr()
419 cc_iowrite(drvdata, CC_HOST_RGF_ICR_REG_OFFSET, irr); in cc_isr()
424 cc_iowrite(drvdata, CC_RNG_IMR_REG_OFFSET, 0xFFFFFFFF); in cc_isr()
429 cc_iowrite(drvdata, CC_HOST_RGF_ICR_REG_OFFSET, in cc_isr()
435 schedule_work(&drvdata->compwork); in cc_isr()
450 struct cctrng_drvdata *drvdata = in cc_trng_startwork_handler() local
453 drvdata->active_rosc = 0; in cc_trng_startwork_handler()
454 cc_trng_hw_trigger(drvdata); in cc_trng_startwork_handler()
459 struct cctrng_drvdata *drvdata; in cctrng_probe() local
469 drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL); in cctrng_probe()
470 if (!drvdata) in cctrng_probe()
473 drvdata->rng.name = devm_kstrdup(dev, dev_name(dev), GFP_KERNEL); in cctrng_probe()
474 if (!drvdata->rng.name) in cctrng_probe()
477 drvdata->rng.read = cctrng_read; in cctrng_probe()
478 drvdata->rng.priv = (unsigned long)drvdata; in cctrng_probe()
479 drvdata->rng.quality = CC_TRNG_QUALITY; in cctrng_probe()
481 platform_set_drvdata(pdev, drvdata); in cctrng_probe()
482 drvdata->pdev = pdev; in cctrng_probe()
484 drvdata->circ.buf = (char *)drvdata->data_buf; in cctrng_probe()
486 drvdata->cc_base = devm_platform_ioremap_resource(pdev, 0); in cctrng_probe()
487 if (IS_ERR(drvdata->cc_base)) in cctrng_probe()
488 return dev_err_probe(dev, PTR_ERR(drvdata->cc_base), "Failed to ioremap registers"); in cctrng_probe()
496 rc = cc_trng_parse_sampling_ratio(drvdata); in cctrng_probe()
500 drvdata->clk = devm_clk_get_optional_enabled(dev, NULL); in cctrng_probe()
501 if (IS_ERR(drvdata->clk)) in cctrng_probe()
502 return dev_err_probe(dev, PTR_ERR(drvdata->clk), in cctrng_probe()
505 INIT_WORK(&drvdata->compwork, cc_trng_compwork_handler); in cctrng_probe()
506 INIT_WORK(&drvdata->startwork, cc_trng_startwork_handler); in cctrng_probe()
507 spin_lock_init(&drvdata->read_lock); in cctrng_probe()
510 rc = devm_request_irq(dev, irq, cc_isr, IRQF_SHARED, "cctrng", drvdata); in cctrng_probe()
516 val = cc_ioread(drvdata, CC_HOST_RGF_IRR_REG_OFFSET); in cctrng_probe()
518 cc_iowrite(drvdata, CC_HOST_RGF_ICR_REG_OFFSET, val); in cctrng_probe()
521 cc_iowrite(drvdata, CC_HOST_RGF_IMR_REG_OFFSET, in cctrng_probe()
522 cc_ioread(drvdata, CC_HOST_RGF_IMR_REG_OFFSET) & in cctrng_probe()
526 rc = cc_trng_pm_init(drvdata); in cctrng_probe()
536 atomic_set(&drvdata->pending_hw, 1); in cctrng_probe()
539 rc = devm_hwrng_register(dev, &drvdata->rng); in cctrng_probe()
546 drvdata->active_rosc = 0; in cctrng_probe()
547 cc_trng_hw_trigger(drvdata); in cctrng_probe()
550 cc_trng_pm_go(drvdata); in cctrng_probe()
557 cc_trng_pm_fini(drvdata); in cctrng_probe()
564 struct cctrng_drvdata *drvdata = platform_get_drvdata(pdev); in cctrng_remove() local
569 cc_trng_pm_fini(drvdata); in cctrng_remove()
576 struct cctrng_drvdata *drvdata = dev_get_drvdata(dev); in cctrng_suspend() local
579 cc_iowrite(drvdata, CC_HOST_POWER_DOWN_EN_REG_OFFSET, in cctrng_suspend()
582 clk_disable_unprepare(drvdata->clk); in cctrng_suspend()
587 static bool cctrng_wait_for_reset_completion(struct cctrng_drvdata *drvdata) in cctrng_wait_for_reset_completion() argument
596 val = cc_ioread(drvdata, CC_NVM_IS_IDLE_REG_OFFSET); in cctrng_wait_for_reset_completion()
610 struct cctrng_drvdata *drvdata = dev_get_drvdata(dev); in cctrng_resume() local
615 rc = clk_prepare_enable(drvdata->clk); in cctrng_resume()
622 if (!cctrng_wait_for_reset_completion(drvdata)) { in cctrng_resume()
624 clk_disable_unprepare(drvdata->clk); in cctrng_resume()
629 cc_iowrite(drvdata, CC_HOST_RGF_IMR_REG_OFFSET, in cctrng_resume()
630 cc_ioread(drvdata, CC_HOST_RGF_IMR_REG_OFFSET) & in cctrng_resume()
633 cc_iowrite(drvdata, CC_HOST_POWER_DOWN_EN_REG_OFFSET, in cctrng_resume()