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()
107 static int cc_trng_pm_init(struct cctrng_drvdata *drvdata) in cc_trng_pm_init() argument
109 struct device *dev = &(drvdata->pdev->dev); in cc_trng_pm_init()
118 static void cc_trng_pm_go(struct cctrng_drvdata *drvdata) in cc_trng_pm_go() argument
120 struct device *dev = &(drvdata->pdev->dev); in cc_trng_pm_go()
126 static void cc_trng_pm_fini(struct cctrng_drvdata *drvdata) in cc_trng_pm_fini() argument
128 struct device *dev = &(drvdata->pdev->dev); in cc_trng_pm_fini()
134 static inline int cc_trng_parse_sampling_ratio(struct cctrng_drvdata *drvdata) in cc_trng_parse_sampling_ratio() argument
136 struct device *dev = &(drvdata->pdev->dev); in cc_trng_parse_sampling_ratio()
137 struct device_node *np = drvdata->pdev->dev.of_node; in cc_trng_parse_sampling_ratio()
144 drvdata->smpl_ratio, in cc_trng_parse_sampling_ratio()
154 i, drvdata->smpl_ratio[i]); in cc_trng_parse_sampling_ratio()
156 if (drvdata->smpl_ratio[i] > 0) in cc_trng_parse_sampling_ratio()
163 static int cc_trng_change_rosc(struct cctrng_drvdata *drvdata) in cc_trng_change_rosc() argument
165 struct device *dev = &(drvdata->pdev->dev); in cc_trng_change_rosc()
167 dev_dbg(dev, "cctrng change rosc (was %d)\n", drvdata->active_rosc); in cc_trng_change_rosc()
168 drvdata->active_rosc += 1; in cc_trng_change_rosc()
170 while (drvdata->active_rosc < CC_TRNG_NUM_OF_ROSCS) { in cc_trng_change_rosc()
171 if (drvdata->smpl_ratio[drvdata->active_rosc] > 0) in cc_trng_change_rosc()
174 drvdata->active_rosc += 1; in cc_trng_change_rosc()
180 static void cc_trng_enable_rnd_source(struct cctrng_drvdata *drvdata) in cc_trng_enable_rnd_source() argument
185 max_cycles = CCTRNG_TIMEOUT(drvdata->smpl_ratio[drvdata->active_rosc]); in cc_trng_enable_rnd_source()
186 cc_iowrite(drvdata, CC_RNG_WATCHDOG_VAL_REG_OFFSET, max_cycles); in cc_trng_enable_rnd_source()
189 cc_iowrite(drvdata, CC_RND_SOURCE_ENABLE_REG_OFFSET, 0x1); in cc_trng_enable_rnd_source()
192 cc_iowrite(drvdata, CC_RNG_IMR_REG_OFFSET, (u32)~CC_RNG_INT_MASK); in cc_trng_enable_rnd_source()
203 static inline size_t circ_buf_space(struct cctrng_drvdata *drvdata) in circ_buf_space() argument
205 return CIRC_SPACE(drvdata->circ.head, in circ_buf_space()
206 drvdata->circ.tail, CCTRNG_DATA_BUF_WORDS); in circ_buf_space()
214 struct cctrng_drvdata *drvdata = (struct cctrng_drvdata *)rng->priv; in cctrng_read() local
215 struct device *dev = &(drvdata->pdev->dev); in cctrng_read()
216 u32 *buf = (u32 *)drvdata->circ.buf; in cctrng_read()
222 if (!spin_trylock(&drvdata->read_lock)) { in cctrng_read()
229 cnt_w = CIRC_CNT_TO_END(drvdata->circ.head, in cctrng_read()
230 drvdata->circ.tail, CCTRNG_DATA_BUF_WORDS); in cctrng_read()
232 memcpy(data, &(buf[drvdata->circ.tail]), size); in cctrng_read()
234 circ_idx_inc(&drvdata->circ.tail, size); in cctrng_read()
238 cnt_w = CIRC_CNT(drvdata->circ.head, in cctrng_read()
239 drvdata->circ.tail, CCTRNG_DATA_BUF_WORDS); in cctrng_read()
241 memcpy(data, &(buf[drvdata->circ.tail]), size); in cctrng_read()
243 circ_idx_inc(&drvdata->circ.tail, size); in cctrng_read()
246 spin_unlock(&drvdata->read_lock); in cctrng_read()
248 if (circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) { in cctrng_read()
249 if (atomic_cmpxchg(&drvdata->pending_hw, 0, 1) == 0) { in cctrng_read()
251 if (circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) { in cctrng_read()
265 schedule_work(&drvdata->startwork); in cctrng_read()
267 atomic_set(&drvdata->pending_hw, 0); in cctrng_read()
275 static void cc_trng_hw_trigger(struct cctrng_drvdata *drvdata) in cc_trng_hw_trigger() argument
278 struct device *dev = &(drvdata->pdev->dev); in cc_trng_hw_trigger()
283 cc_iowrite(drvdata, CC_RNG_CLK_ENABLE_REG_OFFSET, 0x1); in cc_trng_hw_trigger()
286 cc_iowrite(drvdata, CC_RNG_SW_RESET_REG_OFFSET, 0x1); in cc_trng_hw_trigger()
292 cc_iowrite(drvdata, CC_RNG_CLK_ENABLE_REG_OFFSET, 0x1); in cc_trng_hw_trigger()
295 cc_iowrite(drvdata, CC_SAMPLE_CNT1_REG_OFFSET, in cc_trng_hw_trigger()
296 drvdata->smpl_ratio[drvdata->active_rosc]); in cc_trng_hw_trigger()
299 tmp_smpl_cnt = cc_ioread(drvdata, CC_SAMPLE_CNT1_REG_OFFSET); in cc_trng_hw_trigger()
301 } while (tmp_smpl_cnt != drvdata->smpl_ratio[drvdata->active_rosc]); in cc_trng_hw_trigger()
304 cc_iowrite(drvdata, CC_RND_SOURCE_ENABLE_REG_OFFSET, 0); in cc_trng_hw_trigger()
306 cc_iowrite(drvdata, CC_RNG_ICR_REG_OFFSET, 0xFFFFFFFF); in cc_trng_hw_trigger()
308 cc_iowrite(drvdata, CC_TRNG_CONFIG_REG_OFFSET, drvdata->active_rosc); in cc_trng_hw_trigger()
311 cc_iowrite(drvdata, CC_TRNG_DEBUG_CONTROL_REG_OFFSET, 0); in cc_trng_hw_trigger()
313 cc_trng_enable_rnd_source(drvdata); in cc_trng_hw_trigger()
320 struct cctrng_drvdata *drvdata = in cc_trng_compwork_handler() local
322 struct device *dev = &(drvdata->pdev->dev); in cc_trng_compwork_handler()
326 cc_iowrite(drvdata, CC_RNG_DMA_ENABLE_REG_OFFSET, 0); in cc_trng_compwork_handler()
327 cc_iowrite(drvdata, CC_RND_SOURCE_ENABLE_REG_OFFSET, 0); in cc_trng_compwork_handler()
330 isr = cc_ioread(drvdata, CC_RNG_ISR_REG_OFFSET); in cc_trng_compwork_handler()
341 cc_iowrite(drvdata, CC_RNG_ICR_REG_OFFSET, isr); in cc_trng_compwork_handler()
358 u32 *buf = (u32 *)drvdata->circ.buf; in cc_trng_compwork_handler()
360 buf[drvdata->circ.head] = cc_ioread(drvdata, in cc_trng_compwork_handler()
366 if (buf[drvdata->circ.head] == 0) { in cc_trng_compwork_handler()
368 drvdata->active_rosc); in cc_trng_compwork_handler()
372 circ_idx_inc(&drvdata->circ.head, 1<<2); in cc_trng_compwork_handler()
375 atomic_set(&drvdata->pending_hw, 0); in cc_trng_compwork_handler()
378 if (circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) { in cc_trng_compwork_handler()
379 if (atomic_cmpxchg(&drvdata->pending_hw, 0, 1) == 0) { in cc_trng_compwork_handler()
381 cc_trng_enable_rnd_source(drvdata); in cc_trng_compwork_handler()
392 if ((circ_buf_space(drvdata) >= CC_TRNG_EHR_IN_WORDS) && in cc_trng_compwork_handler()
393 (cc_trng_change_rosc(drvdata) == 0)) { in cc_trng_compwork_handler()
395 cc_trng_hw_trigger(drvdata); in cc_trng_compwork_handler()
397 atomic_set(&drvdata->pending_hw, 0); in cc_trng_compwork_handler()
404 struct cctrng_drvdata *drvdata = (struct cctrng_drvdata *)dev_id; in cc_isr() local
405 struct device *dev = &(drvdata->pdev->dev); in cc_isr()
413 irr = cc_ioread(drvdata, CC_HOST_RGF_IRR_REG_OFFSET); in cc_isr()
420 cc_iowrite(drvdata, CC_HOST_RGF_ICR_REG_OFFSET, irr); in cc_isr()
425 cc_iowrite(drvdata, CC_RNG_IMR_REG_OFFSET, 0xFFFFFFFF); in cc_isr()
430 cc_iowrite(drvdata, CC_HOST_RGF_ICR_REG_OFFSET, in cc_isr()
436 schedule_work(&drvdata->compwork); in cc_isr()
451 struct cctrng_drvdata *drvdata = in cc_trng_startwork_handler() local
454 drvdata->active_rosc = 0; in cc_trng_startwork_handler()
455 cc_trng_hw_trigger(drvdata); in cc_trng_startwork_handler()
459 static int cc_trng_clk_init(struct cctrng_drvdata *drvdata) in cc_trng_clk_init() argument
462 struct device *dev = &(drvdata->pdev->dev); in cc_trng_clk_init()
470 drvdata->clk = clk; in cc_trng_clk_init()
472 rc = clk_prepare_enable(drvdata->clk); in cc_trng_clk_init()
481 static void cc_trng_clk_fini(struct cctrng_drvdata *drvdata) in cc_trng_clk_fini() argument
483 clk_disable_unprepare(drvdata->clk); in cc_trng_clk_fini()
489 struct cctrng_drvdata *drvdata; in cctrng_probe() local
495 drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL); in cctrng_probe()
496 if (!drvdata) in cctrng_probe()
499 drvdata->rng.name = devm_kstrdup(dev, dev_name(dev), GFP_KERNEL); in cctrng_probe()
500 if (!drvdata->rng.name) in cctrng_probe()
503 drvdata->rng.read = cctrng_read; in cctrng_probe()
504 drvdata->rng.priv = (unsigned long)drvdata; in cctrng_probe()
505 drvdata->rng.quality = CC_TRNG_QUALITY; in cctrng_probe()
507 platform_set_drvdata(pdev, drvdata); in cctrng_probe()
508 drvdata->pdev = pdev; in cctrng_probe()
510 drvdata->circ.buf = (char *)drvdata->data_buf; in cctrng_probe()
512 drvdata->cc_base = devm_platform_ioremap_resource(pdev, 0); in cctrng_probe()
513 if (IS_ERR(drvdata->cc_base)) { in cctrng_probe()
515 return PTR_ERR(drvdata->cc_base); in cctrng_probe()
524 rc = cc_trng_parse_sampling_ratio(drvdata); in cctrng_probe()
530 rc = cc_trng_clk_init(drvdata); in cctrng_probe()
536 INIT_WORK(&drvdata->compwork, cc_trng_compwork_handler); in cctrng_probe()
537 INIT_WORK(&drvdata->startwork, cc_trng_startwork_handler); in cctrng_probe()
538 spin_lock_init(&drvdata->read_lock); in cctrng_probe()
541 rc = devm_request_irq(dev, irq, cc_isr, IRQF_SHARED, "cctrng", drvdata); in cctrng_probe()
549 val = cc_ioread(drvdata, CC_HOST_RGF_IRR_REG_OFFSET); in cctrng_probe()
551 cc_iowrite(drvdata, CC_HOST_RGF_ICR_REG_OFFSET, val); in cctrng_probe()
554 cc_iowrite(drvdata, CC_HOST_RGF_IMR_REG_OFFSET, in cctrng_probe()
555 cc_ioread(drvdata, CC_HOST_RGF_IMR_REG_OFFSET) & in cctrng_probe()
559 rc = cc_trng_pm_init(drvdata); in cctrng_probe()
573 atomic_set(&drvdata->pending_hw, 1); in cctrng_probe()
576 rc = devm_hwrng_register(dev, &drvdata->rng); in cctrng_probe()
583 drvdata->active_rosc = 0; in cctrng_probe()
584 cc_trng_hw_trigger(drvdata); in cctrng_probe()
587 cc_trng_pm_go(drvdata); in cctrng_probe()
594 cc_trng_pm_fini(drvdata); in cctrng_probe()
597 cc_trng_clk_fini(drvdata); in cctrng_probe()
604 struct cctrng_drvdata *drvdata = platform_get_drvdata(pdev); in cctrng_remove() local
609 cc_trng_pm_fini(drvdata); in cctrng_remove()
611 cc_trng_clk_fini(drvdata); in cctrng_remove()
620 struct cctrng_drvdata *drvdata = dev_get_drvdata(dev); in cctrng_suspend() local
623 cc_iowrite(drvdata, CC_HOST_POWER_DOWN_EN_REG_OFFSET, in cctrng_suspend()
626 clk_disable_unprepare(drvdata->clk); in cctrng_suspend()
631 static bool cctrng_wait_for_reset_completion(struct cctrng_drvdata *drvdata) in cctrng_wait_for_reset_completion() argument
640 val = cc_ioread(drvdata, CC_NVM_IS_IDLE_REG_OFFSET); in cctrng_wait_for_reset_completion()
654 struct cctrng_drvdata *drvdata = dev_get_drvdata(dev); in cctrng_resume() local
659 rc = clk_prepare_enable(drvdata->clk); in cctrng_resume()
666 if (!cctrng_wait_for_reset_completion(drvdata)) { in cctrng_resume()
672 cc_iowrite(drvdata, CC_HOST_RGF_IMR_REG_OFFSET, in cctrng_resume()
673 cc_ioread(drvdata, CC_HOST_RGF_IMR_REG_OFFSET) & in cctrng_resume()
676 cc_iowrite(drvdata, CC_HOST_POWER_DOWN_EN_REG_OFFSET, in cctrng_resume()