1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * TRNG driver for the StarFive JH7110 SoC
4  *
5  * Copyright (C) 2022 StarFive Technology Co.
6  */
7 
8 #include <linux/clk.h>
9 #include <linux/completion.h>
10 #include <linux/delay.h>
11 #include <linux/err.h>
12 #include <linux/hw_random.h>
13 #include <linux/interrupt.h>
14 #include <linux/io.h>
15 #include <linux/iopoll.h>
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/of.h>
19 #include <linux/platform_device.h>
20 #include <linux/pm_runtime.h>
21 #include <linux/random.h>
22 #include <linux/reset.h>
23 
24 /* trng register offset */
25 #define STARFIVE_CTRL			0x00
26 #define STARFIVE_STAT			0x04
27 #define STARFIVE_MODE			0x08
28 #define STARFIVE_SMODE			0x0C
29 #define STARFIVE_IE			0x10
30 #define STARFIVE_ISTAT			0x14
31 #define STARFIVE_RAND0			0x20
32 #define STARFIVE_RAND1			0x24
33 #define STARFIVE_RAND2			0x28
34 #define STARFIVE_RAND3			0x2C
35 #define STARFIVE_RAND4			0x30
36 #define STARFIVE_RAND5			0x34
37 #define STARFIVE_RAND6			0x38
38 #define STARFIVE_RAND7			0x3C
39 #define STARFIVE_AUTO_RQSTS		0x60
40 #define STARFIVE_AUTO_AGE		0x64
41 
42 /* CTRL CMD */
43 #define STARFIVE_CTRL_EXEC_NOP		0x0
44 #define STARFIVE_CTRL_GENE_RANDNUM	0x1
45 #define STARFIVE_CTRL_EXEC_RANDRESEED	0x2
46 
47 /* STAT */
48 #define STARFIVE_STAT_NONCE_MODE	BIT(2)
49 #define STARFIVE_STAT_R256		BIT(3)
50 #define STARFIVE_STAT_MISSION_MODE	BIT(8)
51 #define STARFIVE_STAT_SEEDED		BIT(9)
52 #define STARFIVE_STAT_LAST_RESEED(x)	((x) << 16)
53 #define STARFIVE_STAT_SRVC_RQST		BIT(27)
54 #define STARFIVE_STAT_RAND_GENERATING	BIT(30)
55 #define STARFIVE_STAT_RAND_SEEDING	BIT(31)
56 
57 /* MODE */
58 #define STARFIVE_MODE_R256		BIT(3)
59 
60 /* SMODE */
61 #define STARFIVE_SMODE_NONCE_MODE	BIT(2)
62 #define STARFIVE_SMODE_MISSION_MODE	BIT(8)
63 #define STARFIVE_SMODE_MAX_REJECTS(x)	((x) << 16)
64 
65 /* IE */
66 #define STARFIVE_IE_RAND_RDY_EN		BIT(0)
67 #define STARFIVE_IE_SEED_DONE_EN	BIT(1)
68 #define STARFIVE_IE_LFSR_LOCKUP_EN	BIT(4)
69 #define STARFIVE_IE_GLBL_EN		BIT(31)
70 
71 #define STARFIVE_IE_ALL			(STARFIVE_IE_GLBL_EN | \
72 					 STARFIVE_IE_RAND_RDY_EN | \
73 					 STARFIVE_IE_SEED_DONE_EN | \
74 					 STARFIVE_IE_LFSR_LOCKUP_EN)
75 
76 /* ISTAT */
77 #define STARFIVE_ISTAT_RAND_RDY		BIT(0)
78 #define STARFIVE_ISTAT_SEED_DONE	BIT(1)
79 #define STARFIVE_ISTAT_LFSR_LOCKUP	BIT(4)
80 
81 #define STARFIVE_RAND_LEN		sizeof(u32)
82 
83 #define to_trng(p)			container_of(p, struct starfive_trng, rng)
84 
85 enum reseed {
86 	RANDOM_RESEED,
87 	NONCE_RESEED,
88 };
89 
90 enum mode {
91 	PRNG_128BIT,
92 	PRNG_256BIT,
93 };
94 
95 struct starfive_trng {
96 	struct device		*dev;
97 	void __iomem		*base;
98 	struct clk		*hclk;
99 	struct clk		*ahb;
100 	struct reset_control	*rst;
101 	struct hwrng		rng;
102 	struct completion	random_done;
103 	struct completion	reseed_done;
104 	u32			mode;
105 	u32			mission;
106 	u32			reseed;
107 	/* protects against concurrent write to ctrl register */
108 	spinlock_t		write_lock;
109 };
110 
111 static u16 autoreq;
112 module_param(autoreq, ushort, 0);
113 MODULE_PARM_DESC(autoreq, "Auto-reseeding after random number requests by host reaches specified counter:\n"
114 				" 0 - disable counter\n"
115 				" other - reload value for internal counter");
116 
117 static u16 autoage;
118 module_param(autoage, ushort, 0);
119 MODULE_PARM_DESC(autoage, "Auto-reseeding after specified timer countdowns to 0:\n"
120 				" 0 - disable timer\n"
121 				" other - reload value for internal timer");
122 
starfive_trng_wait_idle(struct starfive_trng * trng)123 static inline int starfive_trng_wait_idle(struct starfive_trng *trng)
124 {
125 	u32 stat;
126 
127 	return readl_relaxed_poll_timeout(trng->base + STARFIVE_STAT, stat,
128 					  !(stat & (STARFIVE_STAT_RAND_GENERATING |
129 						    STARFIVE_STAT_RAND_SEEDING)),
130 					  10, 100000);
131 }
132 
starfive_trng_irq_mask_clear(struct starfive_trng * trng)133 static inline void starfive_trng_irq_mask_clear(struct starfive_trng *trng)
134 {
135 	/* clear register: ISTAT */
136 	u32 data = readl(trng->base + STARFIVE_ISTAT);
137 
138 	writel(data, trng->base + STARFIVE_ISTAT);
139 }
140 
starfive_trng_cmd(struct starfive_trng * trng,u32 cmd,bool wait)141 static int starfive_trng_cmd(struct starfive_trng *trng, u32 cmd, bool wait)
142 {
143 	int wait_time = 1000;
144 
145 	/* allow up to 40 us for wait == 0 */
146 	if (!wait)
147 		wait_time = 40;
148 
149 	switch (cmd) {
150 	case STARFIVE_CTRL_GENE_RANDNUM:
151 		reinit_completion(&trng->random_done);
152 		spin_lock_irq(&trng->write_lock);
153 		writel(cmd, trng->base + STARFIVE_CTRL);
154 		spin_unlock_irq(&trng->write_lock);
155 		if (!wait_for_completion_timeout(&trng->random_done, usecs_to_jiffies(wait_time)))
156 			return -ETIMEDOUT;
157 		break;
158 	case STARFIVE_CTRL_EXEC_RANDRESEED:
159 		reinit_completion(&trng->reseed_done);
160 		spin_lock_irq(&trng->write_lock);
161 		writel(cmd, trng->base + STARFIVE_CTRL);
162 		spin_unlock_irq(&trng->write_lock);
163 		if (!wait_for_completion_timeout(&trng->reseed_done, usecs_to_jiffies(wait_time)))
164 			return -ETIMEDOUT;
165 		break;
166 	default:
167 		return -EINVAL;
168 	}
169 
170 	return 0;
171 }
172 
starfive_trng_init(struct hwrng * rng)173 static int starfive_trng_init(struct hwrng *rng)
174 {
175 	struct starfive_trng *trng = to_trng(rng);
176 	u32 mode, intr = 0;
177 
178 	/* setup Auto Request/Age register */
179 	writel(autoage, trng->base + STARFIVE_AUTO_AGE);
180 	writel(autoreq, trng->base + STARFIVE_AUTO_RQSTS);
181 
182 	/* clear register: ISTAT */
183 	starfive_trng_irq_mask_clear(trng);
184 
185 	intr |= STARFIVE_IE_ALL;
186 	writel(intr, trng->base + STARFIVE_IE);
187 
188 	mode  = readl(trng->base + STARFIVE_MODE);
189 
190 	switch (trng->mode) {
191 	case PRNG_128BIT:
192 		mode &= ~STARFIVE_MODE_R256;
193 		break;
194 	case PRNG_256BIT:
195 		mode |= STARFIVE_MODE_R256;
196 		break;
197 	default:
198 		mode |= STARFIVE_MODE_R256;
199 		break;
200 	}
201 
202 	writel(mode, trng->base + STARFIVE_MODE);
203 
204 	return starfive_trng_cmd(trng, STARFIVE_CTRL_EXEC_RANDRESEED, 1);
205 }
206 
starfive_trng_irq(int irq,void * priv)207 static irqreturn_t starfive_trng_irq(int irq, void *priv)
208 {
209 	u32 status;
210 	struct starfive_trng *trng = (struct starfive_trng *)priv;
211 
212 	status = readl(trng->base + STARFIVE_ISTAT);
213 	if (status & STARFIVE_ISTAT_RAND_RDY) {
214 		writel(STARFIVE_ISTAT_RAND_RDY, trng->base + STARFIVE_ISTAT);
215 		complete(&trng->random_done);
216 	}
217 
218 	if (status & STARFIVE_ISTAT_SEED_DONE) {
219 		writel(STARFIVE_ISTAT_SEED_DONE, trng->base + STARFIVE_ISTAT);
220 		complete(&trng->reseed_done);
221 	}
222 
223 	if (status & STARFIVE_ISTAT_LFSR_LOCKUP) {
224 		writel(STARFIVE_ISTAT_LFSR_LOCKUP, trng->base + STARFIVE_ISTAT);
225 		/* SEU occurred, reseeding required*/
226 		spin_lock(&trng->write_lock);
227 		writel(STARFIVE_CTRL_EXEC_RANDRESEED, trng->base + STARFIVE_CTRL);
228 		spin_unlock(&trng->write_lock);
229 	}
230 
231 	return IRQ_HANDLED;
232 }
233 
starfive_trng_cleanup(struct hwrng * rng)234 static void starfive_trng_cleanup(struct hwrng *rng)
235 {
236 	struct starfive_trng *trng = to_trng(rng);
237 
238 	writel(0, trng->base + STARFIVE_CTRL);
239 
240 	reset_control_assert(trng->rst);
241 	clk_disable_unprepare(trng->hclk);
242 	clk_disable_unprepare(trng->ahb);
243 }
244 
starfive_trng_read(struct hwrng * rng,void * buf,size_t max,bool wait)245 static int starfive_trng_read(struct hwrng *rng, void *buf, size_t max, bool wait)
246 {
247 	struct starfive_trng *trng = to_trng(rng);
248 	int ret;
249 
250 	pm_runtime_get_sync(trng->dev);
251 
252 	if (trng->mode == PRNG_256BIT)
253 		max = min_t(size_t, max, (STARFIVE_RAND_LEN * 8));
254 	else
255 		max = min_t(size_t, max, (STARFIVE_RAND_LEN * 4));
256 
257 	if (wait) {
258 		ret = starfive_trng_wait_idle(trng);
259 		if (ret)
260 			return -ETIMEDOUT;
261 	}
262 
263 	ret = starfive_trng_cmd(trng, STARFIVE_CTRL_GENE_RANDNUM, wait);
264 	if (ret)
265 		return ret;
266 
267 	memcpy_fromio(buf, trng->base + STARFIVE_RAND0, max);
268 
269 	pm_runtime_put_sync_autosuspend(trng->dev);
270 
271 	return max;
272 }
273 
starfive_trng_probe(struct platform_device * pdev)274 static int starfive_trng_probe(struct platform_device *pdev)
275 {
276 	int ret;
277 	int irq;
278 	struct starfive_trng *trng;
279 
280 	trng = devm_kzalloc(&pdev->dev, sizeof(*trng), GFP_KERNEL);
281 	if (!trng)
282 		return -ENOMEM;
283 
284 	platform_set_drvdata(pdev, trng);
285 	trng->dev = &pdev->dev;
286 
287 	trng->base = devm_platform_ioremap_resource(pdev, 0);
288 	if (IS_ERR(trng->base))
289 		return dev_err_probe(&pdev->dev, PTR_ERR(trng->base),
290 				     "Error remapping memory for platform device.\n");
291 
292 	irq = platform_get_irq(pdev, 0);
293 	if (irq < 0)
294 		return irq;
295 
296 	init_completion(&trng->random_done);
297 	init_completion(&trng->reseed_done);
298 	spin_lock_init(&trng->write_lock);
299 
300 	ret = devm_request_irq(&pdev->dev, irq, starfive_trng_irq, 0, pdev->name,
301 			       (void *)trng);
302 	if (ret)
303 		return dev_err_probe(&pdev->dev, ret,
304 				     "Failed to register interrupt handler\n");
305 
306 	trng->hclk = devm_clk_get(&pdev->dev, "hclk");
307 	if (IS_ERR(trng->hclk))
308 		return dev_err_probe(&pdev->dev, PTR_ERR(trng->hclk),
309 				     "Error getting hardware reference clock\n");
310 
311 	trng->ahb = devm_clk_get(&pdev->dev, "ahb");
312 	if (IS_ERR(trng->ahb))
313 		return dev_err_probe(&pdev->dev, PTR_ERR(trng->ahb),
314 				     "Error getting ahb reference clock\n");
315 
316 	trng->rst = devm_reset_control_get_shared(&pdev->dev, NULL);
317 	if (IS_ERR(trng->rst))
318 		return dev_err_probe(&pdev->dev, PTR_ERR(trng->rst),
319 				     "Error getting hardware reset line\n");
320 
321 	clk_prepare_enable(trng->hclk);
322 	clk_prepare_enable(trng->ahb);
323 	reset_control_deassert(trng->rst);
324 
325 	trng->rng.name = dev_driver_string(&pdev->dev);
326 	trng->rng.init = starfive_trng_init;
327 	trng->rng.cleanup = starfive_trng_cleanup;
328 	trng->rng.read = starfive_trng_read;
329 
330 	trng->mode = PRNG_256BIT;
331 	trng->mission = 1;
332 	trng->reseed = RANDOM_RESEED;
333 
334 	pm_runtime_use_autosuspend(&pdev->dev);
335 	pm_runtime_set_autosuspend_delay(&pdev->dev, 100);
336 	pm_runtime_enable(&pdev->dev);
337 
338 	ret = devm_hwrng_register(&pdev->dev, &trng->rng);
339 	if (ret) {
340 		pm_runtime_disable(&pdev->dev);
341 
342 		reset_control_assert(trng->rst);
343 		clk_disable_unprepare(trng->ahb);
344 		clk_disable_unprepare(trng->hclk);
345 
346 		return dev_err_probe(&pdev->dev, ret, "Failed to register hwrng\n");
347 	}
348 
349 	return 0;
350 }
351 
starfive_trng_suspend(struct device * dev)352 static int __maybe_unused starfive_trng_suspend(struct device *dev)
353 {
354 	struct starfive_trng *trng = dev_get_drvdata(dev);
355 
356 	clk_disable_unprepare(trng->hclk);
357 	clk_disable_unprepare(trng->ahb);
358 
359 	return 0;
360 }
361 
starfive_trng_resume(struct device * dev)362 static int __maybe_unused starfive_trng_resume(struct device *dev)
363 {
364 	struct starfive_trng *trng = dev_get_drvdata(dev);
365 
366 	clk_prepare_enable(trng->hclk);
367 	clk_prepare_enable(trng->ahb);
368 
369 	return 0;
370 }
371 
372 static DEFINE_SIMPLE_DEV_PM_OPS(starfive_trng_pm_ops, starfive_trng_suspend,
373 				starfive_trng_resume);
374 
375 static const struct of_device_id trng_dt_ids[] __maybe_unused = {
376 	{ .compatible = "starfive,jh7110-trng" },
377 	{ }
378 };
379 MODULE_DEVICE_TABLE(of, trng_dt_ids);
380 
381 static struct platform_driver starfive_trng_driver = {
382 	.probe	= starfive_trng_probe,
383 	.driver	= {
384 		.name		= "jh7110-trng",
385 		.pm		= &starfive_trng_pm_ops,
386 		.of_match_table	= of_match_ptr(trng_dt_ids),
387 	},
388 };
389 
390 module_platform_driver(starfive_trng_driver);
391 
392 MODULE_LICENSE("GPL");
393 MODULE_DESCRIPTION("StarFive True Random Number Generator");
394