Linux Audio

Check our new training course

Loading...
v6.8
  1/*
  2 * hw_random/core.c: HWRNG core API
  3 *
  4 * Copyright 2006 Michael Buesch <m@bues.ch>
  5 * Copyright 2005 (c) MontaVista Software, Inc.
  6 *
  7 * Please read Documentation/admin-guide/hw_random.rst for details on use.
  8 *
  9 * This software may be used and distributed according to the terms
 10 * of the GNU General Public License, incorporated herein by reference.
 11 */
 12
 13#include <linux/delay.h>
 14#include <linux/device.h>
 15#include <linux/err.h>
 16#include <linux/fs.h>
 17#include <linux/hw_random.h>
 18#include <linux/kernel.h>
 19#include <linux/kthread.h>
 20#include <linux/miscdevice.h>
 21#include <linux/module.h>
 22#include <linux/random.h>
 23#include <linux/sched.h>
 24#include <linux/sched/signal.h>
 25#include <linux/slab.h>
 26#include <linux/string.h>
 27#include <linux/uaccess.h>
 28
 29#define RNG_MODULE_NAME		"hw_random"
 30
 31#define RNG_BUFFER_SIZE (SMP_CACHE_BYTES < 32 ? 32 : SMP_CACHE_BYTES)
 32
 33static struct hwrng *current_rng;
 34/* the current rng has been explicitly chosen by user via sysfs */
 35static int cur_rng_set_by_user;
 36static struct task_struct *hwrng_fill;
 37/* list of registered rngs */
 38static LIST_HEAD(rng_list);
 39/* Protects rng_list and current_rng */
 40static DEFINE_MUTEX(rng_mutex);
 41/* Protects rng read functions, data_avail, rng_buffer and rng_fillbuf */
 42static DEFINE_MUTEX(reading_mutex);
 43static int data_avail;
 44static u8 *rng_buffer, *rng_fillbuf;
 45static unsigned short current_quality;
 46static unsigned short default_quality = 1024; /* default to maximum */
 47
 48module_param(current_quality, ushort, 0644);
 49MODULE_PARM_DESC(current_quality,
 50		 "current hwrng entropy estimation per 1024 bits of input -- obsolete, use rng_quality instead");
 51module_param(default_quality, ushort, 0644);
 52MODULE_PARM_DESC(default_quality,
 53		 "default maximum entropy content of hwrng per 1024 bits of input");
 54
 55static void drop_current_rng(void);
 56static int hwrng_init(struct hwrng *rng);
 57static int hwrng_fillfn(void *unused);
 58
 59static inline int rng_get_data(struct hwrng *rng, u8 *buffer, size_t size,
 60			       int wait);
 61
 62static size_t rng_buffer_size(void)
 63{
 64	return RNG_BUFFER_SIZE;
 65}
 66
 67static void add_early_randomness(struct hwrng *rng)
 68{
 69	int bytes_read;
 70
 71	mutex_lock(&reading_mutex);
 72	bytes_read = rng_get_data(rng, rng_fillbuf, 32, 0);
 73	mutex_unlock(&reading_mutex);
 74	if (bytes_read > 0) {
 75		size_t entropy = bytes_read * 8 * rng->quality / 1024;
 76		add_hwgenerator_randomness(rng_fillbuf, bytes_read, entropy, false);
 77	}
 78}
 79
 80static inline void cleanup_rng(struct kref *kref)
 81{
 82	struct hwrng *rng = container_of(kref, struct hwrng, ref);
 83
 84	if (rng->cleanup)
 85		rng->cleanup(rng);
 86
 87	complete(&rng->cleanup_done);
 88}
 89
 90static int set_current_rng(struct hwrng *rng)
 91{
 92	int err;
 93
 94	BUG_ON(!mutex_is_locked(&rng_mutex));
 95
 96	err = hwrng_init(rng);
 97	if (err)
 98		return err;
 99
100	drop_current_rng();
101	current_rng = rng;
102
103	/* if necessary, start hwrng thread */
104	if (!hwrng_fill) {
105		hwrng_fill = kthread_run(hwrng_fillfn, NULL, "hwrng");
106		if (IS_ERR(hwrng_fill)) {
107			pr_err("hwrng_fill thread creation failed\n");
108			hwrng_fill = NULL;
109		}
110	}
111
112	return 0;
113}
114
115static void drop_current_rng(void)
116{
117	BUG_ON(!mutex_is_locked(&rng_mutex));
118	if (!current_rng)
119		return;
120
121	/* decrease last reference for triggering the cleanup */
122	kref_put(&current_rng->ref, cleanup_rng);
123	current_rng = NULL;
124}
125
126/* Returns ERR_PTR(), NULL or refcounted hwrng */
127static struct hwrng *get_current_rng_nolock(void)
128{
129	if (current_rng)
130		kref_get(&current_rng->ref);
131
132	return current_rng;
133}
134
135static struct hwrng *get_current_rng(void)
136{
137	struct hwrng *rng;
138
139	if (mutex_lock_interruptible(&rng_mutex))
140		return ERR_PTR(-ERESTARTSYS);
141
142	rng = get_current_rng_nolock();
143
144	mutex_unlock(&rng_mutex);
145	return rng;
146}
147
148static void put_rng(struct hwrng *rng)
149{
150	/*
151	 * Hold rng_mutex here so we serialize in case they set_current_rng
152	 * on rng again immediately.
153	 */
154	mutex_lock(&rng_mutex);
155	if (rng)
156		kref_put(&rng->ref, cleanup_rng);
157	mutex_unlock(&rng_mutex);
158}
159
160static int hwrng_init(struct hwrng *rng)
161{
162	if (kref_get_unless_zero(&rng->ref))
163		goto skip_init;
164
165	if (rng->init) {
166		int ret;
167
168		ret =  rng->init(rng);
169		if (ret)
170			return ret;
171	}
172
173	kref_init(&rng->ref);
174	reinit_completion(&rng->cleanup_done);
175
176skip_init:
177	rng->quality = min_t(u16, min_t(u16, default_quality, 1024), rng->quality ?: 1024);
178	current_quality = rng->quality; /* obsolete */
179
180	return 0;
181}
182
183static int rng_dev_open(struct inode *inode, struct file *filp)
184{
185	/* enforce read-only access to this chrdev */
186	if ((filp->f_mode & FMODE_READ) == 0)
187		return -EINVAL;
188	if (filp->f_mode & FMODE_WRITE)
189		return -EINVAL;
190	return 0;
191}
192
193static inline int rng_get_data(struct hwrng *rng, u8 *buffer, size_t size,
194			int wait) {
195	int present;
196
197	BUG_ON(!mutex_is_locked(&reading_mutex));
198	if (rng->read)
199		return rng->read(rng, (void *)buffer, size, wait);
 
 
 
 
 
 
 
200
201	if (rng->data_present)
202		present = rng->data_present(rng, wait);
203	else
204		present = 1;
205
206	if (present)
207		return rng->data_read(rng, (u32 *)buffer);
208
209	return 0;
210}
211
212static ssize_t rng_dev_read(struct file *filp, char __user *buf,
213			    size_t size, loff_t *offp)
214{
215	u8 buffer[RNG_BUFFER_SIZE];
216	ssize_t ret = 0;
217	int err = 0;
218	int bytes_read, len;
219	struct hwrng *rng;
220
221	while (size) {
222		rng = get_current_rng();
223		if (IS_ERR(rng)) {
224			err = PTR_ERR(rng);
225			goto out;
226		}
227		if (!rng) {
228			err = -ENODEV;
229			goto out;
230		}
231
232		if (mutex_lock_interruptible(&reading_mutex)) {
233			err = -ERESTARTSYS;
234			goto out_put;
235		}
236		if (!data_avail) {
237			bytes_read = rng_get_data(rng, rng_buffer,
238				rng_buffer_size(),
239				!(filp->f_flags & O_NONBLOCK));
240			if (bytes_read < 0) {
241				err = bytes_read;
242				goto out_unlock_reading;
243			} else if (bytes_read == 0 &&
244				   (filp->f_flags & O_NONBLOCK)) {
245				err = -EAGAIN;
246				goto out_unlock_reading;
247			}
248
249			data_avail = bytes_read;
250		}
251
252		len = data_avail;
253		if (len) {
254			if (len > size)
255				len = size;
256
257			data_avail -= len;
258
259			memcpy(buffer, rng_buffer + data_avail, len);
260		}
261		mutex_unlock(&reading_mutex);
262		put_rng(rng);
263
264		if (len) {
265			if (copy_to_user(buf + ret, buffer, len)) {
266				err = -EFAULT;
267				goto out;
268			}
269
270			size -= len;
271			ret += len;
272		}
273
274
275		if (need_resched())
276			schedule_timeout_interruptible(1);
277
278		if (signal_pending(current)) {
279			err = -ERESTARTSYS;
280			goto out;
281		}
282	}
283out:
284	memzero_explicit(buffer, sizeof(buffer));
285	return ret ? : err;
286
287out_unlock_reading:
288	mutex_unlock(&reading_mutex);
289out_put:
290	put_rng(rng);
291	goto out;
292}
293
294static const struct file_operations rng_chrdev_ops = {
295	.owner		= THIS_MODULE,
296	.open		= rng_dev_open,
297	.read		= rng_dev_read,
298	.llseek		= noop_llseek,
299};
300
301static const struct attribute_group *rng_dev_groups[];
302
303static struct miscdevice rng_miscdev = {
304	.minor		= HWRNG_MINOR,
305	.name		= RNG_MODULE_NAME,
306	.nodename	= "hwrng",
307	.fops		= &rng_chrdev_ops,
308	.groups		= rng_dev_groups,
309};
310
311static int enable_best_rng(void)
312{
313	struct hwrng *rng, *new_rng = NULL;
314	int ret = -ENODEV;
315
316	BUG_ON(!mutex_is_locked(&rng_mutex));
317
318	/* no rng to use? */
319	if (list_empty(&rng_list)) {
320		drop_current_rng();
321		cur_rng_set_by_user = 0;
322		return 0;
323	}
324
325	/* use the rng which offers the best quality */
326	list_for_each_entry(rng, &rng_list, list) {
327		if (!new_rng || rng->quality > new_rng->quality)
328			new_rng = rng;
329	}
330
331	ret = ((new_rng == current_rng) ? 0 : set_current_rng(new_rng));
332	if (!ret)
333		cur_rng_set_by_user = 0;
334
335	return ret;
336}
337
338static ssize_t rng_current_store(struct device *dev,
339				 struct device_attribute *attr,
340				 const char *buf, size_t len)
341{
342	int err;
343	struct hwrng *rng, *old_rng, *new_rng;
344
345	err = mutex_lock_interruptible(&rng_mutex);
346	if (err)
347		return -ERESTARTSYS;
348
349	old_rng = current_rng;
350	if (sysfs_streq(buf, "")) {
351		err = enable_best_rng();
352	} else {
353		list_for_each_entry(rng, &rng_list, list) {
354			if (sysfs_streq(rng->name, buf)) {
355				err = set_current_rng(rng);
356				if (!err)
357					cur_rng_set_by_user = 1;
358				break;
359			}
360		}
361	}
362	new_rng = get_current_rng_nolock();
363	mutex_unlock(&rng_mutex);
364
365	if (new_rng) {
366		if (new_rng != old_rng)
367			add_early_randomness(new_rng);
368		put_rng(new_rng);
369	}
370
371	return err ? : len;
372}
373
374static ssize_t rng_current_show(struct device *dev,
375				struct device_attribute *attr,
376				char *buf)
377{
378	ssize_t ret;
379	struct hwrng *rng;
380
381	rng = get_current_rng();
382	if (IS_ERR(rng))
383		return PTR_ERR(rng);
384
385	ret = snprintf(buf, PAGE_SIZE, "%s\n", rng ? rng->name : "none");
386	put_rng(rng);
387
388	return ret;
389}
390
391static ssize_t rng_available_show(struct device *dev,
392				  struct device_attribute *attr,
393				  char *buf)
394{
395	int err;
396	struct hwrng *rng;
397
398	err = mutex_lock_interruptible(&rng_mutex);
399	if (err)
400		return -ERESTARTSYS;
401	buf[0] = '\0';
402	list_for_each_entry(rng, &rng_list, list) {
403		strlcat(buf, rng->name, PAGE_SIZE);
404		strlcat(buf, " ", PAGE_SIZE);
405	}
406	strlcat(buf, "\n", PAGE_SIZE);
407	mutex_unlock(&rng_mutex);
408
409	return strlen(buf);
410}
411
412static ssize_t rng_selected_show(struct device *dev,
413				 struct device_attribute *attr,
414				 char *buf)
415{
416	return sysfs_emit(buf, "%d\n", cur_rng_set_by_user);
417}
418
419static ssize_t rng_quality_show(struct device *dev,
420				struct device_attribute *attr,
421				char *buf)
422{
423	ssize_t ret;
424	struct hwrng *rng;
425
426	rng = get_current_rng();
427	if (IS_ERR(rng))
428		return PTR_ERR(rng);
429
430	if (!rng) /* no need to put_rng */
431		return -ENODEV;
432
433	ret = sysfs_emit(buf, "%hu\n", rng->quality);
434	put_rng(rng);
435
436	return ret;
437}
438
439static ssize_t rng_quality_store(struct device *dev,
440				 struct device_attribute *attr,
441				 const char *buf, size_t len)
442{
443	u16 quality;
444	int ret = -EINVAL;
445
446	if (len < 2)
447		return -EINVAL;
448
449	ret = mutex_lock_interruptible(&rng_mutex);
450	if (ret)
451		return -ERESTARTSYS;
452
453	ret = kstrtou16(buf, 0, &quality);
454	if (ret || quality > 1024) {
455		ret = -EINVAL;
456		goto out;
457	}
458
459	if (!current_rng) {
460		ret = -ENODEV;
461		goto out;
462	}
463
464	current_rng->quality = quality;
465	current_quality = quality; /* obsolete */
466
467	/* the best available RNG may have changed */
468	ret = enable_best_rng();
469
470out:
471	mutex_unlock(&rng_mutex);
472	return ret ? ret : len;
473}
474
475static DEVICE_ATTR_RW(rng_current);
476static DEVICE_ATTR_RO(rng_available);
477static DEVICE_ATTR_RO(rng_selected);
478static DEVICE_ATTR_RW(rng_quality);
479
480static struct attribute *rng_dev_attrs[] = {
481	&dev_attr_rng_current.attr,
482	&dev_attr_rng_available.attr,
483	&dev_attr_rng_selected.attr,
484	&dev_attr_rng_quality.attr,
485	NULL
486};
487
488ATTRIBUTE_GROUPS(rng_dev);
489
490static void __exit unregister_miscdev(void)
491{
492	misc_deregister(&rng_miscdev);
493}
494
495static int __init register_miscdev(void)
496{
497	return misc_register(&rng_miscdev);
498}
499
500static int hwrng_fillfn(void *unused)
501{
502	size_t entropy, entropy_credit = 0; /* in 1/1024 of a bit */
503	long rc;
504
505	while (!kthread_should_stop()) {
506		unsigned short quality;
507		struct hwrng *rng;
508
509		rng = get_current_rng();
510		if (IS_ERR(rng) || !rng)
511			break;
512		mutex_lock(&reading_mutex);
513		rc = rng_get_data(rng, rng_fillbuf,
514				  rng_buffer_size(), 1);
515		if (current_quality != rng->quality)
516			rng->quality = current_quality; /* obsolete */
517		quality = rng->quality;
518		mutex_unlock(&reading_mutex);
519
520		if (rc <= 0)
521			hwrng_msleep(rng, 10000);
522
523		put_rng(rng);
524
525		if (rc <= 0)
526			continue;
527
528		/* If we cannot credit at least one bit of entropy,
529		 * keep track of the remainder for the next iteration
530		 */
531		entropy = rc * quality * 8 + entropy_credit;
532		if ((entropy >> 10) == 0)
533			entropy_credit = entropy;
534
535		/* Outside lock, sure, but y'know: randomness. */
536		add_hwgenerator_randomness((void *)rng_fillbuf, rc,
537					   entropy >> 10, true);
538	}
539	hwrng_fill = NULL;
540	return 0;
541}
542
543int hwrng_register(struct hwrng *rng)
544{
545	int err = -EINVAL;
546	struct hwrng *tmp;
547	bool is_new_current = false;
548
549	if (!rng->name || (!rng->data_read && !rng->read))
550		goto out;
551
552	mutex_lock(&rng_mutex);
553
554	/* Must not register two RNGs with the same name. */
555	err = -EEXIST;
556	list_for_each_entry(tmp, &rng_list, list) {
557		if (strcmp(tmp->name, rng->name) == 0)
558			goto out_unlock;
559	}
560	list_add_tail(&rng->list, &rng_list);
561
562	init_completion(&rng->cleanup_done);
563	complete(&rng->cleanup_done);
564	init_completion(&rng->dying);
565
 
 
 
566	if (!current_rng ||
567	    (!cur_rng_set_by_user && rng->quality > current_rng->quality)) {
568		/*
569		 * Set new rng as current as the new rng source
570		 * provides better entropy quality and was not
571		 * chosen by userspace.
572		 */
573		err = set_current_rng(rng);
574		if (err)
575			goto out_unlock;
576		/* to use current_rng in add_early_randomness() we need
577		 * to take a ref
578		 */
579		is_new_current = true;
580		kref_get(&rng->ref);
581	}
582	mutex_unlock(&rng_mutex);
583	if (is_new_current || !rng->init) {
584		/*
585		 * Use a new device's input to add some randomness to
586		 * the system.  If this rng device isn't going to be
587		 * used right away, its init function hasn't been
588		 * called yet by set_current_rng(); so only use the
589		 * randomness from devices that don't need an init callback
590		 */
591		add_early_randomness(rng);
592	}
593	if (is_new_current)
594		put_rng(rng);
595	return 0;
596out_unlock:
597	mutex_unlock(&rng_mutex);
598out:
599	return err;
600}
601EXPORT_SYMBOL_GPL(hwrng_register);
602
603void hwrng_unregister(struct hwrng *rng)
604{
605	struct hwrng *old_rng, *new_rng;
606	int err;
607
608	mutex_lock(&rng_mutex);
609
610	old_rng = current_rng;
611	list_del(&rng->list);
612	complete_all(&rng->dying);
613	if (current_rng == rng) {
614		err = enable_best_rng();
615		if (err) {
616			drop_current_rng();
617			cur_rng_set_by_user = 0;
618		}
619	}
620
621	new_rng = get_current_rng_nolock();
622	if (list_empty(&rng_list)) {
623		mutex_unlock(&rng_mutex);
624		if (hwrng_fill)
625			kthread_stop(hwrng_fill);
626	} else
627		mutex_unlock(&rng_mutex);
628
629	if (new_rng) {
630		if (old_rng != new_rng)
631			add_early_randomness(new_rng);
632		put_rng(new_rng);
633	}
634
635	wait_for_completion(&rng->cleanup_done);
636}
637EXPORT_SYMBOL_GPL(hwrng_unregister);
638
639static void devm_hwrng_release(struct device *dev, void *res)
640{
641	hwrng_unregister(*(struct hwrng **)res);
642}
643
644static int devm_hwrng_match(struct device *dev, void *res, void *data)
645{
646	struct hwrng **r = res;
647
648	if (WARN_ON(!r || !*r))
649		return 0;
650
651	return *r == data;
652}
653
654int devm_hwrng_register(struct device *dev, struct hwrng *rng)
655{
656	struct hwrng **ptr;
657	int error;
658
659	ptr = devres_alloc(devm_hwrng_release, sizeof(*ptr), GFP_KERNEL);
660	if (!ptr)
661		return -ENOMEM;
662
663	error = hwrng_register(rng);
664	if (error) {
665		devres_free(ptr);
666		return error;
667	}
668
669	*ptr = rng;
670	devres_add(dev, ptr);
671	return 0;
672}
673EXPORT_SYMBOL_GPL(devm_hwrng_register);
674
675void devm_hwrng_unregister(struct device *dev, struct hwrng *rng)
676{
677	devres_release(dev, devm_hwrng_release, devm_hwrng_match, rng);
678}
679EXPORT_SYMBOL_GPL(devm_hwrng_unregister);
680
681long hwrng_msleep(struct hwrng *rng, unsigned int msecs)
682{
683	unsigned long timeout = msecs_to_jiffies(msecs) + 1;
684
685	return wait_for_completion_interruptible_timeout(&rng->dying, timeout);
686}
687EXPORT_SYMBOL_GPL(hwrng_msleep);
688
689long hwrng_yield(struct hwrng *rng)
690{
691	return wait_for_completion_interruptible_timeout(&rng->dying, 1);
692}
693EXPORT_SYMBOL_GPL(hwrng_yield);
694
695static int __init hwrng_modinit(void)
696{
697	int ret;
698
699	/* kmalloc makes this safe for virt_to_page() in virtio_rng.c */
700	rng_buffer = kmalloc(rng_buffer_size(), GFP_KERNEL);
701	if (!rng_buffer)
702		return -ENOMEM;
703
704	rng_fillbuf = kmalloc(rng_buffer_size(), GFP_KERNEL);
705	if (!rng_fillbuf) {
706		kfree(rng_buffer);
707		return -ENOMEM;
708	}
709
710	ret = register_miscdev();
711	if (ret) {
712		kfree(rng_fillbuf);
713		kfree(rng_buffer);
714	}
715
716	return ret;
717}
718
719static void __exit hwrng_modexit(void)
720{
721	mutex_lock(&rng_mutex);
722	BUG_ON(current_rng);
723	kfree(rng_buffer);
724	kfree(rng_fillbuf);
725	mutex_unlock(&rng_mutex);
726
727	unregister_miscdev();
728}
729
730fs_initcall(hwrng_modinit); /* depends on misc_register() */
731module_exit(hwrng_modexit);
732
733MODULE_DESCRIPTION("H/W Random Number Generator (RNG) driver");
734MODULE_LICENSE("GPL");
v6.13.7
  1/*
  2 * hw_random/core.c: HWRNG core API
  3 *
  4 * Copyright 2006 Michael Buesch <m@bues.ch>
  5 * Copyright 2005 (c) MontaVista Software, Inc.
  6 *
  7 * Please read Documentation/admin-guide/hw_random.rst for details on use.
  8 *
  9 * This software may be used and distributed according to the terms
 10 * of the GNU General Public License, incorporated herein by reference.
 11 */
 12
 13#include <linux/delay.h>
 14#include <linux/device.h>
 15#include <linux/err.h>
 16#include <linux/fs.h>
 17#include <linux/hw_random.h>
 18#include <linux/kernel.h>
 19#include <linux/kthread.h>
 20#include <linux/miscdevice.h>
 21#include <linux/module.h>
 22#include <linux/random.h>
 23#include <linux/sched.h>
 24#include <linux/sched/signal.h>
 25#include <linux/slab.h>
 26#include <linux/string.h>
 27#include <linux/uaccess.h>
 28
 29#define RNG_MODULE_NAME		"hw_random"
 30
 31#define RNG_BUFFER_SIZE (SMP_CACHE_BYTES < 32 ? 32 : SMP_CACHE_BYTES)
 32
 33static struct hwrng *current_rng;
 34/* the current rng has been explicitly chosen by user via sysfs */
 35static int cur_rng_set_by_user;
 36static struct task_struct *hwrng_fill;
 37/* list of registered rngs */
 38static LIST_HEAD(rng_list);
 39/* Protects rng_list and current_rng */
 40static DEFINE_MUTEX(rng_mutex);
 41/* Protects rng read functions, data_avail, rng_buffer and rng_fillbuf */
 42static DEFINE_MUTEX(reading_mutex);
 43static int data_avail;
 44static u8 *rng_buffer, *rng_fillbuf;
 45static unsigned short current_quality;
 46static unsigned short default_quality = 1024; /* default to maximum */
 47
 48module_param(current_quality, ushort, 0644);
 49MODULE_PARM_DESC(current_quality,
 50		 "current hwrng entropy estimation per 1024 bits of input -- obsolete, use rng_quality instead");
 51module_param(default_quality, ushort, 0644);
 52MODULE_PARM_DESC(default_quality,
 53		 "default maximum entropy content of hwrng per 1024 bits of input");
 54
 55static void drop_current_rng(void);
 56static int hwrng_init(struct hwrng *rng);
 57static int hwrng_fillfn(void *unused);
 58
 59static inline int rng_get_data(struct hwrng *rng, u8 *buffer, size_t size,
 60			       int wait);
 61
 62static size_t rng_buffer_size(void)
 63{
 64	return RNG_BUFFER_SIZE;
 65}
 66
 
 
 
 
 
 
 
 
 
 
 
 
 
 67static inline void cleanup_rng(struct kref *kref)
 68{
 69	struct hwrng *rng = container_of(kref, struct hwrng, ref);
 70
 71	if (rng->cleanup)
 72		rng->cleanup(rng);
 73
 74	complete(&rng->cleanup_done);
 75}
 76
 77static int set_current_rng(struct hwrng *rng)
 78{
 79	int err;
 80
 81	BUG_ON(!mutex_is_locked(&rng_mutex));
 82
 83	err = hwrng_init(rng);
 84	if (err)
 85		return err;
 86
 87	drop_current_rng();
 88	current_rng = rng;
 89
 90	/* if necessary, start hwrng thread */
 91	if (!hwrng_fill) {
 92		hwrng_fill = kthread_run(hwrng_fillfn, NULL, "hwrng");
 93		if (IS_ERR(hwrng_fill)) {
 94			pr_err("hwrng_fill thread creation failed\n");
 95			hwrng_fill = NULL;
 96		}
 97	}
 98
 99	return 0;
100}
101
102static void drop_current_rng(void)
103{
104	BUG_ON(!mutex_is_locked(&rng_mutex));
105	if (!current_rng)
106		return;
107
108	/* decrease last reference for triggering the cleanup */
109	kref_put(&current_rng->ref, cleanup_rng);
110	current_rng = NULL;
111}
112
113/* Returns ERR_PTR(), NULL or refcounted hwrng */
114static struct hwrng *get_current_rng_nolock(void)
115{
116	if (current_rng)
117		kref_get(&current_rng->ref);
118
119	return current_rng;
120}
121
122static struct hwrng *get_current_rng(void)
123{
124	struct hwrng *rng;
125
126	if (mutex_lock_interruptible(&rng_mutex))
127		return ERR_PTR(-ERESTARTSYS);
128
129	rng = get_current_rng_nolock();
130
131	mutex_unlock(&rng_mutex);
132	return rng;
133}
134
135static void put_rng(struct hwrng *rng)
136{
137	/*
138	 * Hold rng_mutex here so we serialize in case they set_current_rng
139	 * on rng again immediately.
140	 */
141	mutex_lock(&rng_mutex);
142	if (rng)
143		kref_put(&rng->ref, cleanup_rng);
144	mutex_unlock(&rng_mutex);
145}
146
147static int hwrng_init(struct hwrng *rng)
148{
149	if (kref_get_unless_zero(&rng->ref))
150		goto skip_init;
151
152	if (rng->init) {
153		int ret;
154
155		ret =  rng->init(rng);
156		if (ret)
157			return ret;
158	}
159
160	kref_init(&rng->ref);
161	reinit_completion(&rng->cleanup_done);
162
163skip_init:
 
164	current_quality = rng->quality; /* obsolete */
165
166	return 0;
167}
168
169static int rng_dev_open(struct inode *inode, struct file *filp)
170{
171	/* enforce read-only access to this chrdev */
172	if ((filp->f_mode & FMODE_READ) == 0)
173		return -EINVAL;
174	if (filp->f_mode & FMODE_WRITE)
175		return -EINVAL;
176	return 0;
177}
178
179static inline int rng_get_data(struct hwrng *rng, u8 *buffer, size_t size,
180			int wait) {
181	int present;
182
183	BUG_ON(!mutex_is_locked(&reading_mutex));
184	if (rng->read) {
185		int err;
186
187		err = rng->read(rng, buffer, size, wait);
188		if (WARN_ON_ONCE(err > 0 && err > size))
189			err = size;
190
191		return err;
192	}
193
194	if (rng->data_present)
195		present = rng->data_present(rng, wait);
196	else
197		present = 1;
198
199	if (present)
200		return rng->data_read(rng, (u32 *)buffer);
201
202	return 0;
203}
204
205static ssize_t rng_dev_read(struct file *filp, char __user *buf,
206			    size_t size, loff_t *offp)
207{
208	u8 buffer[RNG_BUFFER_SIZE];
209	ssize_t ret = 0;
210	int err = 0;
211	int bytes_read, len;
212	struct hwrng *rng;
213
214	while (size) {
215		rng = get_current_rng();
216		if (IS_ERR(rng)) {
217			err = PTR_ERR(rng);
218			goto out;
219		}
220		if (!rng) {
221			err = -ENODEV;
222			goto out;
223		}
224
225		if (mutex_lock_interruptible(&reading_mutex)) {
226			err = -ERESTARTSYS;
227			goto out_put;
228		}
229		if (!data_avail) {
230			bytes_read = rng_get_data(rng, rng_buffer,
231				rng_buffer_size(),
232				!(filp->f_flags & O_NONBLOCK));
233			if (bytes_read < 0) {
234				err = bytes_read;
235				goto out_unlock_reading;
236			} else if (bytes_read == 0 &&
237				   (filp->f_flags & O_NONBLOCK)) {
238				err = -EAGAIN;
239				goto out_unlock_reading;
240			}
241
242			data_avail = bytes_read;
243		}
244
245		len = data_avail;
246		if (len) {
247			if (len > size)
248				len = size;
249
250			data_avail -= len;
251
252			memcpy(buffer, rng_buffer + data_avail, len);
253		}
254		mutex_unlock(&reading_mutex);
255		put_rng(rng);
256
257		if (len) {
258			if (copy_to_user(buf + ret, buffer, len)) {
259				err = -EFAULT;
260				goto out;
261			}
262
263			size -= len;
264			ret += len;
265		}
266
267
268		if (need_resched())
269			schedule_timeout_interruptible(1);
270
271		if (signal_pending(current)) {
272			err = -ERESTARTSYS;
273			goto out;
274		}
275	}
276out:
277	memzero_explicit(buffer, sizeof(buffer));
278	return ret ? : err;
279
280out_unlock_reading:
281	mutex_unlock(&reading_mutex);
282out_put:
283	put_rng(rng);
284	goto out;
285}
286
287static const struct file_operations rng_chrdev_ops = {
288	.owner		= THIS_MODULE,
289	.open		= rng_dev_open,
290	.read		= rng_dev_read,
291	.llseek		= noop_llseek,
292};
293
294static const struct attribute_group *rng_dev_groups[];
295
296static struct miscdevice rng_miscdev = {
297	.minor		= HWRNG_MINOR,
298	.name		= RNG_MODULE_NAME,
299	.nodename	= "hwrng",
300	.fops		= &rng_chrdev_ops,
301	.groups		= rng_dev_groups,
302};
303
304static int enable_best_rng(void)
305{
306	struct hwrng *rng, *new_rng = NULL;
307	int ret = -ENODEV;
308
309	BUG_ON(!mutex_is_locked(&rng_mutex));
310
311	/* no rng to use? */
312	if (list_empty(&rng_list)) {
313		drop_current_rng();
314		cur_rng_set_by_user = 0;
315		return 0;
316	}
317
318	/* use the rng which offers the best quality */
319	list_for_each_entry(rng, &rng_list, list) {
320		if (!new_rng || rng->quality > new_rng->quality)
321			new_rng = rng;
322	}
323
324	ret = ((new_rng == current_rng) ? 0 : set_current_rng(new_rng));
325	if (!ret)
326		cur_rng_set_by_user = 0;
327
328	return ret;
329}
330
331static ssize_t rng_current_store(struct device *dev,
332				 struct device_attribute *attr,
333				 const char *buf, size_t len)
334{
335	int err;
336	struct hwrng *rng, *new_rng;
337
338	err = mutex_lock_interruptible(&rng_mutex);
339	if (err)
340		return -ERESTARTSYS;
341
 
342	if (sysfs_streq(buf, "")) {
343		err = enable_best_rng();
344	} else {
345		list_for_each_entry(rng, &rng_list, list) {
346			if (sysfs_streq(rng->name, buf)) {
347				err = set_current_rng(rng);
348				if (!err)
349					cur_rng_set_by_user = 1;
350				break;
351			}
352		}
353	}
354	new_rng = get_current_rng_nolock();
355	mutex_unlock(&rng_mutex);
356
357	if (new_rng)
 
 
358		put_rng(new_rng);
 
359
360	return err ? : len;
361}
362
363static ssize_t rng_current_show(struct device *dev,
364				struct device_attribute *attr,
365				char *buf)
366{
367	ssize_t ret;
368	struct hwrng *rng;
369
370	rng = get_current_rng();
371	if (IS_ERR(rng))
372		return PTR_ERR(rng);
373
374	ret = sysfs_emit(buf, "%s\n", rng ? rng->name : "none");
375	put_rng(rng);
376
377	return ret;
378}
379
380static ssize_t rng_available_show(struct device *dev,
381				  struct device_attribute *attr,
382				  char *buf)
383{
384	int err;
385	struct hwrng *rng;
386
387	err = mutex_lock_interruptible(&rng_mutex);
388	if (err)
389		return -ERESTARTSYS;
390	buf[0] = '\0';
391	list_for_each_entry(rng, &rng_list, list) {
392		strlcat(buf, rng->name, PAGE_SIZE);
393		strlcat(buf, " ", PAGE_SIZE);
394	}
395	strlcat(buf, "\n", PAGE_SIZE);
396	mutex_unlock(&rng_mutex);
397
398	return strlen(buf);
399}
400
401static ssize_t rng_selected_show(struct device *dev,
402				 struct device_attribute *attr,
403				 char *buf)
404{
405	return sysfs_emit(buf, "%d\n", cur_rng_set_by_user);
406}
407
408static ssize_t rng_quality_show(struct device *dev,
409				struct device_attribute *attr,
410				char *buf)
411{
412	ssize_t ret;
413	struct hwrng *rng;
414
415	rng = get_current_rng();
416	if (IS_ERR(rng))
417		return PTR_ERR(rng);
418
419	if (!rng) /* no need to put_rng */
420		return -ENODEV;
421
422	ret = sysfs_emit(buf, "%hu\n", rng->quality);
423	put_rng(rng);
424
425	return ret;
426}
427
428static ssize_t rng_quality_store(struct device *dev,
429				 struct device_attribute *attr,
430				 const char *buf, size_t len)
431{
432	u16 quality;
433	int ret = -EINVAL;
434
435	if (len < 2)
436		return -EINVAL;
437
438	ret = mutex_lock_interruptible(&rng_mutex);
439	if (ret)
440		return -ERESTARTSYS;
441
442	ret = kstrtou16(buf, 0, &quality);
443	if (ret || quality > 1024) {
444		ret = -EINVAL;
445		goto out;
446	}
447
448	if (!current_rng) {
449		ret = -ENODEV;
450		goto out;
451	}
452
453	current_rng->quality = quality;
454	current_quality = quality; /* obsolete */
455
456	/* the best available RNG may have changed */
457	ret = enable_best_rng();
458
459out:
460	mutex_unlock(&rng_mutex);
461	return ret ? ret : len;
462}
463
464static DEVICE_ATTR_RW(rng_current);
465static DEVICE_ATTR_RO(rng_available);
466static DEVICE_ATTR_RO(rng_selected);
467static DEVICE_ATTR_RW(rng_quality);
468
469static struct attribute *rng_dev_attrs[] = {
470	&dev_attr_rng_current.attr,
471	&dev_attr_rng_available.attr,
472	&dev_attr_rng_selected.attr,
473	&dev_attr_rng_quality.attr,
474	NULL
475};
476
477ATTRIBUTE_GROUPS(rng_dev);
478
 
 
 
 
 
 
 
 
 
 
479static int hwrng_fillfn(void *unused)
480{
481	size_t entropy, entropy_credit = 0; /* in 1/1024 of a bit */
482	long rc;
483
484	while (!kthread_should_stop()) {
485		unsigned short quality;
486		struct hwrng *rng;
487
488		rng = get_current_rng();
489		if (IS_ERR(rng) || !rng)
490			break;
491		mutex_lock(&reading_mutex);
492		rc = rng_get_data(rng, rng_fillbuf,
493				  rng_buffer_size(), 1);
494		if (current_quality != rng->quality)
495			rng->quality = current_quality; /* obsolete */
496		quality = rng->quality;
497		mutex_unlock(&reading_mutex);
498
499		if (rc <= 0)
500			hwrng_msleep(rng, 10000);
501
502		put_rng(rng);
503
504		if (rc <= 0)
505			continue;
506
507		/* If we cannot credit at least one bit of entropy,
508		 * keep track of the remainder for the next iteration
509		 */
510		entropy = rc * quality * 8 + entropy_credit;
511		if ((entropy >> 10) == 0)
512			entropy_credit = entropy;
513
514		/* Outside lock, sure, but y'know: randomness. */
515		add_hwgenerator_randomness((void *)rng_fillbuf, rc,
516					   entropy >> 10, true);
517	}
518	hwrng_fill = NULL;
519	return 0;
520}
521
522int hwrng_register(struct hwrng *rng)
523{
524	int err = -EINVAL;
525	struct hwrng *tmp;
 
526
527	if (!rng->name || (!rng->data_read && !rng->read))
528		goto out;
529
530	mutex_lock(&rng_mutex);
531
532	/* Must not register two RNGs with the same name. */
533	err = -EEXIST;
534	list_for_each_entry(tmp, &rng_list, list) {
535		if (strcmp(tmp->name, rng->name) == 0)
536			goto out_unlock;
537	}
538	list_add_tail(&rng->list, &rng_list);
539
540	init_completion(&rng->cleanup_done);
541	complete(&rng->cleanup_done);
542	init_completion(&rng->dying);
543
544	/* Adjust quality field to always have a proper value */
545	rng->quality = min_t(u16, min_t(u16, default_quality, 1024), rng->quality ?: 1024);
546
547	if (!current_rng ||
548	    (!cur_rng_set_by_user && rng->quality > current_rng->quality)) {
549		/*
550		 * Set new rng as current as the new rng source
551		 * provides better entropy quality and was not
552		 * chosen by userspace.
553		 */
554		err = set_current_rng(rng);
555		if (err)
556			goto out_unlock;
 
 
 
 
 
557	}
558	mutex_unlock(&rng_mutex);
 
 
 
 
 
 
 
 
 
 
 
 
559	return 0;
560out_unlock:
561	mutex_unlock(&rng_mutex);
562out:
563	return err;
564}
565EXPORT_SYMBOL_GPL(hwrng_register);
566
567void hwrng_unregister(struct hwrng *rng)
568{
569	struct hwrng *new_rng;
570	int err;
571
572	mutex_lock(&rng_mutex);
573
 
574	list_del(&rng->list);
575	complete_all(&rng->dying);
576	if (current_rng == rng) {
577		err = enable_best_rng();
578		if (err) {
579			drop_current_rng();
580			cur_rng_set_by_user = 0;
581		}
582	}
583
584	new_rng = get_current_rng_nolock();
585	if (list_empty(&rng_list)) {
586		mutex_unlock(&rng_mutex);
587		if (hwrng_fill)
588			kthread_stop(hwrng_fill);
589	} else
590		mutex_unlock(&rng_mutex);
591
592	if (new_rng)
 
 
593		put_rng(new_rng);
 
594
595	wait_for_completion(&rng->cleanup_done);
596}
597EXPORT_SYMBOL_GPL(hwrng_unregister);
598
599static void devm_hwrng_release(struct device *dev, void *res)
600{
601	hwrng_unregister(*(struct hwrng **)res);
602}
603
604static int devm_hwrng_match(struct device *dev, void *res, void *data)
605{
606	struct hwrng **r = res;
607
608	if (WARN_ON(!r || !*r))
609		return 0;
610
611	return *r == data;
612}
613
614int devm_hwrng_register(struct device *dev, struct hwrng *rng)
615{
616	struct hwrng **ptr;
617	int error;
618
619	ptr = devres_alloc(devm_hwrng_release, sizeof(*ptr), GFP_KERNEL);
620	if (!ptr)
621		return -ENOMEM;
622
623	error = hwrng_register(rng);
624	if (error) {
625		devres_free(ptr);
626		return error;
627	}
628
629	*ptr = rng;
630	devres_add(dev, ptr);
631	return 0;
632}
633EXPORT_SYMBOL_GPL(devm_hwrng_register);
634
635void devm_hwrng_unregister(struct device *dev, struct hwrng *rng)
636{
637	devres_release(dev, devm_hwrng_release, devm_hwrng_match, rng);
638}
639EXPORT_SYMBOL_GPL(devm_hwrng_unregister);
640
641long hwrng_msleep(struct hwrng *rng, unsigned int msecs)
642{
643	unsigned long timeout = msecs_to_jiffies(msecs) + 1;
644
645	return wait_for_completion_interruptible_timeout(&rng->dying, timeout);
646}
647EXPORT_SYMBOL_GPL(hwrng_msleep);
648
649long hwrng_yield(struct hwrng *rng)
650{
651	return wait_for_completion_interruptible_timeout(&rng->dying, 1);
652}
653EXPORT_SYMBOL_GPL(hwrng_yield);
654
655static int __init hwrng_modinit(void)
656{
657	int ret;
658
659	/* kmalloc makes this safe for virt_to_page() in virtio_rng.c */
660	rng_buffer = kmalloc(rng_buffer_size(), GFP_KERNEL);
661	if (!rng_buffer)
662		return -ENOMEM;
663
664	rng_fillbuf = kmalloc(rng_buffer_size(), GFP_KERNEL);
665	if (!rng_fillbuf) {
666		kfree(rng_buffer);
667		return -ENOMEM;
668	}
669
670	ret = misc_register(&rng_miscdev);
671	if (ret) {
672		kfree(rng_fillbuf);
673		kfree(rng_buffer);
674	}
675
676	return ret;
677}
678
679static void __exit hwrng_modexit(void)
680{
681	mutex_lock(&rng_mutex);
682	BUG_ON(current_rng);
683	kfree(rng_buffer);
684	kfree(rng_fillbuf);
685	mutex_unlock(&rng_mutex);
686
687	misc_deregister(&rng_miscdev);
688}
689
690fs_initcall(hwrng_modinit); /* depends on misc_register() */
691module_exit(hwrng_modexit);
692
693MODULE_DESCRIPTION("H/W Random Number Generator (RNG) driver");
694MODULE_LICENSE("GPL");