altos/usbtrng-v2.0: Use stmf042 hardware CRC unit

[fw/altos] / src / usbtrng-v2.0 / ao_usbtrng.c

diff --git a/src/usbtrng-v2.0/ao_usbtrng.c b/src/usbtrng-v2.0/ao_usbtrng.c
index 9b6fd4f188c68308529620c4992aa9abc548e7f2..26cfbac92953cc0d9da28d3253199891e328662e 100644 (file)
--- a/src/usbtrng-v2.0/ao_usbtrng.c
+++ b/src/usbtrng-v2.0/ao_usbtrng.c
@@ -16,16 +16,58 @@
  */
 
 #include <ao.h>
+#include <ao_adc_fast.h>
+#include <ao_crc.h>
 
-static void ao_blink(void)
+static void
+ao_trng_fetch(void)
 {
-       for (;;) {
-               ao_led_toggle(LEDS_AVAILABLE);
-               ao_delay(AO_MS_TO_TICKS(500));
+       static uint16_t *buffer[2];
+       static uint32_t adc_in[AO_USB_IN_SIZE/2];       /* twice as many as we need */
+       uint32_t        kbytes = 1;
+       uint32_t        count;
+       int             usb_buf_id;
+       int             i;
+       uint16_t        *buf;
+       uint32_t        *rnd;
+
+       if (!buffer[0]) {
+               buffer[0] = ao_usb_alloc();
+               buffer[1] = ao_usb_alloc();
+               if (!buffer[0])
+                       return;
+       }
+
+       ao_cmd_decimal();
+       if (ao_cmd_status == ao_cmd_success)
+               kbytes = ao_cmd_lex_u32;
+       else
+               ao_cmd_status = ao_cmd_success;
+       usb_buf_id = 0;
+       count = kbytes * (1024/AO_USB_IN_SIZE);
+
+       ao_crc_reset();
+
+       ao_led_on(AO_LED_GREEN);
+       while (count--) {
+               ao_adc_read((uint16_t *) adc_in, AO_USB_IN_SIZE);
+               rnd = adc_in;
+               buf = buffer[usb_buf_id];
+               for (i = 0; i < 32; i++)
+                       *buf++ = ao_crc_in_32_out_16(*rnd++);
+               ao_led_toggle(AO_LED_GREEN|AO_LED_RED);
+               ao_usb_write(buffer[usb_buf_id], AO_USB_IN_SIZE);
+               ao_led_toggle(AO_LED_GREEN|AO_LED_RED);
+               usb_buf_id = 1-usb_buf_id;
        }
+       ao_led_off(AO_LED_GREEN|AO_LED_RED);
+       ao_usb_flush();
 }
 
-struct ao_task blink_task;
+static const struct ao_cmds usbtrng_cmds[] = {
+       { ao_trng_fetch,        "f <kbytes>\0Fetch a block of numbers" },
+       { 0, NULL },
+};
 
 void main(void)
 {
@@ -34,12 +76,16 @@ void main(void)
        ao_clock_init();
        ao_task_init();
        ao_timer_init();
+       ao_dma_init();
+       ao_adc_init();
+       ao_crc_init();
 
        ao_cmd_init();
 
        ao_usb_init();
 
-       ao_add_task(&blink_task, ao_blink, "blink");
+       ao_cmd_register(usbtrng_cmds);
+       ao_led_off(AO_LED_RED);
 
        ao_start_scheduler();
 }