summaryrefslogtreecommitdiffstats
path: root/bsps/arm/atsam/start/getentropy-trng.c
blob: ed65f3cd89b4726a5090544b445e7c5904a07a74 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
/*
 * Copyright (c) 2017 embedded brains GmbH.  All rights reserved.
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 * http://www.rtems.org/license/LICENSE.
 */

#include <libchip/chip.h>
#include <unistd.h>
#include <string.h>
#include <rtems/sysinit.h>

static void atsam_trng_enable(void)
{
	PMC_EnablePeripheral(ID_TRNG);
	TRNG_Enable();
}

int getentropy(void *ptr, size_t n)
{
	while (n > 0) {
		uint32_t random;
		size_t copy;

		while ((TRNG_GetStatus() & TRNG_ISR_DATRDY) == 0) {
			/* wait */
		}
		random = TRNG_GetRandData();

		/*
		 * Read TRNG status one more time to avoid race condition.
		 * Otherwise we can read (and clear) an old ready status but get
		 * a new value. The ready status for this value wouldn't be
		 * reset.
		 */
		TRNG_GetStatus();

		copy = sizeof(random);
		if (n < copy ) {
			copy = n;
		}
		memcpy(ptr, &random, copy);
		n -= copy;
		ptr += copy;
	}

	return 0;
}

RTEMS_SYSINIT_ITEM(
  atsam_trng_enable,
  RTEMS_SYSINIT_DEVICE_DRIVERS,
  RTEMS_SYSINIT_ORDER_LAST_BUT_5
);