5-malloc.md (#25)

[lunaix-os.git] / lunaix-os / hal / rng / rngx86.c

diff --git a/lunaix-os/hal/rng/rngx86.c b/lunaix-os/hal/rng/rngx86.c
index af11802a43378de27c63f40ee62cb911e6ca4629..0b8a586cd7e057228c2965d4b23ec55f1005577d 100644 (file)
--- a/lunaix-os/hal/rng/rngx86.c
+++ b/lunaix-os/hal/rng/rngx86.c
@@ -1,6 +1,8 @@
 #include <lunaix/device.h>
 #include <lunaix/mm/page.h>
 
 #include <lunaix/device.h>
 #include <lunaix/mm/page.h>
 

+#include <klibc/string.h>
+

 static inline void
 rng_fill(void* data, size_t len)
 {
 static inline void
 rng_fill(void* data, size_t len)
 {


@@ -24,23 +26,31 @@ __rand_rd_pg(struct device* dev, void* buf, size_t offset)
 static int
 __rand_rd(struct device* dev, void* buf, size_t offset, size_t len)
 {
 static int
 __rand_rd(struct device* dev, void* buf, size_t offset, size_t len)
 {

-    rng_fill(buf, len);
+    if (unlikely(len < 4)) {
+        int tmp_buf = 0;
+        rng_fill(&tmp_buf, 4);
+        memcpy(buf, &tmp_buf, len);
+    } else {
+        rng_fill(buf, len);
+    }

     return len;
 }
 
 int
 pdev_randdev_init(struct device_def* devdef)
 {
     return len;
 }
 
 int
 pdev_randdev_init(struct device_def* devdef)
 {

-    struct device* devrand = device_addseq(NULL, NULL, "rand");
+    // FIXME add check on cpuid for presence of rdrand
+    struct device* devrand = device_allocseq(NULL, NULL);

     devrand->ops.read = __rand_rd;
     devrand->ops.read_page = __rand_rd_pg;
 
     devrand->ops.read = __rand_rd;
     devrand->ops.read_page = __rand_rd_pg;
 

+    register_device(devrand, &devdef->class, "rand");
+

     return 0;
 }
 
 static struct device_def devrandx86_def = {
     .name = "x86 On-Chip RNG",
     return 0;
 }
 
 static struct device_def devrandx86_def = {
     .name = "x86 On-Chip RNG",

-    .class = DEVCLASS(DEVIF_SOC, DEVFN_CHAR, DEV_RNG, 0),
-    .init = pdev_randdev_init
-};
-EXPORT_DEVICE(randdev, &devrandx86_def, load_earlystage);
\ No newline at end of file
+    .class = DEVCLASS(DEVIF_SOC, DEVFN_CHAR, DEV_RNG),
+    .init = pdev_randdev_init};
+EXPORT_DEVICE(randdev, &devrandx86_def, load_onboot);
\ No newline at end of file