tls_rng.c 1.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182
  1. /* Software DRBG: see tls_rng.h. */
  2. #include "tls_rng.h"
  3. #include "tls_sha256.h"
  4. #include "ucmd_lib.h"
  5. static unsigned char state[32];
  6. static unsigned char ctr[32];
  7. static int seeded;
  8. static void mix(const void *data, unsigned int len)
  9. {
  10. struct sha256_ctx c;
  11. sha256_init(&c);
  12. sha256_update(&c, state, 32);
  13. if (len)
  14. sha256_update(&c, data, len);
  15. sha256_final(&c, state);
  16. }
  17. static void seed(void)
  18. {
  19. struct sys_netinfo ni;
  20. unsigned char sample[64];
  21. unsigned int i;
  22. unsigned int t;
  23. for (i = 0; i < 32; i++)
  24. state[i] = (unsigned char)(0xA5 ^ i);
  25. /* RDTSC jitter: pairs of closely-spaced reads. */
  26. for (i = 0; i < 64; i += 4) {
  27. unsigned int lo1, lo2, hi;
  28. __asm__ volatile ("rdtsc" : "=a"(lo1), "=d"(hi));
  29. __asm__ volatile ("rdtsc" : "=a"(lo2), "=d"(hi));
  30. sample[i] = (unsigned char)lo1;
  31. sample[i + 1] = (unsigned char)(lo2 >> 5);
  32. sample[i + 2] = (unsigned char)(lo1 >> 13);
  33. sample[i + 3] = (unsigned char)(lo2 >> 21);
  34. }
  35. mix(sample, 64);
  36. t = (unsigned int)u_syscall0(SYS_GET_TICKS_MS);
  37. mix(&t, sizeof(t));
  38. if (u_syscall1(SYS_NET_INFO, (int)&ni) == 1)
  39. mix(ni.mac, 6);
  40. seeded = 1;
  41. }
  42. void tls_random(unsigned char *out, unsigned int len)
  43. {
  44. struct sha256_ctx c;
  45. unsigned char block[32];
  46. unsigned int i, n;
  47. int j;
  48. if (!seeded)
  49. seed();
  50. while (len) {
  51. sha256_init(&c);
  52. sha256_update(&c, state, 32);
  53. sha256_update(&c, ctr, 32);
  54. sha256_final(&c, block);
  55. mix(block, 32);
  56. for (j = 31; j >= 0; j--) { /* ctr++ (big endian) */
  57. if (++ctr[j] != 0)
  58. break;
  59. }
  60. n = len < 32 ? len : 32;
  61. for (i = 0; i < n; i++)
  62. out[i] = block[i];
  63. out += n;
  64. len -= n;
  65. }
  66. }